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Abstract 


-V 

Two  extended  Kalman  filter  algorithms  that  estimate 
target  position,  velocity,  and  acceleration,  as  well  as 
atmospheric  jitter  are  developed  for  use  within  a  laser 
weapon  system.  Digital  signal  processing  techniques  are 
employed  on  data  obtained  from  a  forward  looking  infrared 
(FLIR)  sensor  in  order  to  identify  the  underlying  shape  of 


"multiple  hot-spot"  targets.  No  a  priori  information  is 
assumed  about  such  Images.  The  identified  shape  is  used  in 
the  measurement  model  portion  of  the  extended  Kalman  filters 
in  order  to  estimate  target  position  offsets  from  the  center 
of  the  sensor  field  of  view.  The  two  dynamics  models 
incorporated  within  the  filters  are  1)  a  first  order  Gauss- 
Markov  acceleration  model  and  2)  a  constant  turn-rate 
acceleration  model.  Performance  of  these  two  filters  are 
compared  in  tracking  scenarios  involving  constant  G  and 
constant  roll-rate  maneuvers.  Extensive  consideration  is 
given  to  simulating  realistic  multiple  hot-spot  images  on 
the  FLIR  image  plane.  Performance  of  a  previously  developed 


adaptive  filter  is  shown  to  be  seriously  degraded  when  faced 
with  multiple  hot-spot  images  since  it  assumes  a  priori 
information  about  the  targt  image.  All  evaluations  are 
conducted  using  Monte  Carlo  techniques.  ^ 


Since  their  initial  development,  lasers  have  been  used 
for  many  purposes  throughout  the  medical,  industrial,  scien¬ 
tific  and  military  fields.  Such  applications  have  varied 
widely  from  the  use  of  low  power  lasers  for  precision 
surgery  to  the  use  of  high  energy  lasers  for  their 
destructive  potential.  In  particular,  the  high  energy  laser 
(HEL)  has  become  very  attractive  to  the  United  States  Air 
Force  for  use  as  a  key  component  of  various  weapon  systems. 
An  example  of  one  such  system  is  a  ground-based,  anti- 
aircraf t/antl-misslle  weapon  system.  The  advantages  of  a 
HEL  system  over  conventional  systems  would  include  the 
ability  to  be  used  repeatedly  and  to  deliver  large  amounts 
of  energy  over  long  distances  essentially  Instantaneously. 

Although  the  technology  to  produce  and  transmit  lethal 
amounts  of  energy  does  exist,  various  other  problems  are 
still  present.  A  major  obstacle  is  the  precision  pointing 
of  the  laser  and  accurate  tracking  of  the  target.  It  is  not 
sufficient  simply  to  sweep  the  laser  beam  across  the  target; 
Instead,  it  must  be  held  at  one  location  for  some  finite 
period  of  time.  Factors  that  work  against  this  are  the 
motion  of  the  target  Itself  and  the  effect  of  the  atmosphere 
on  the  propagation  of  the  beam.  Thus  the  realization  of  a 
HEL  weapon  system  is  dependent  upon  the  development  of  a 
tracker  capable  of  performing  effectively  against  a  variety 
of  targets  and  environments. 


1.1 


C’,  •, 


I 


The  basic  components  of  a  HEL  weapon  system  are  the 
laser  itself,  the  sensor  that  supplies  measurements  and  to 
which  the  laser  is  servoed  (or  shares  an  aperature  with), 
and  a  control  subsystem.  One  commonly  used  sensor,  the  one 
that  will  be  referred  to  throughout  this  research,  is  the 
Forward  Looking  Infra-Red  sensor  (FLIR).  The  control 
subsystem  consists  of  a  tracker  and  gimbal  controllers.  The 
tracker  utilizes  sensor  measurements  to  generate  an  estimate 
of  the  target  position  offset  from  the  center  of  the  field 
of  view  of  the  sensor,  which  is  provided  to  the  gimbal 
controllers  to  re-position  the  FLIR/laser.  Traditionally, 
correlation  algorithms  alone  have  been  used  to  provide  the 
necessary  position  offset  information  to  the  gimbal 
.  controllers.  This  Information  was  generated  by  comparing 
"templates"  of  predetermined  or  real-time-obtained  target 
Images  with  the  most  current  set  of  measurements  acquired 
from  sensors.  However,  while  being  robust  in  the  sense  that 
it  can  operate  successfully  despite  image  shapes  and 
environments  that  may  vary  widely,  this  algorithm  has 
several  major  disadvantages:  it  is  susceptible  to  noise,  it 
is  not  sensitive  to  knowledge  of  target  dynamics,  and  it 
does  not  account  for  the  atmospheric  distortion  that 
radiated  beams  experience. 

In  order  to  overcome  these  deficiencies,  a  considerable 
amount  of  effort  has  been  expended  in  recent  years,  at  the 
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Air  Force  Institute  of  Technology,  to  develop  an  effective 
Extended  Kalman  Filter  (EKF)  algorithm  for  precision 
poiri  3  ;  d  tracking  (Ref:  3,5,12,16,17,19).  In  an  initial 
feaslbllicy  study  (Ref:  12),  a  simple  EKF  algorithm  was 
designed  to  track  a  distant  (point  source)  target  exhibiting 
rather  benign  dynamics.  Target  estimates  were  based  upon 
FLIR  measurement  data  that  was  assumed  to  be  corrupted  by 
temporally  and  spatially  uncorrelated  noises.  In  this 
study,  Mercler  took  into  account  the  fact  that  apparent 
target  location  (from  FLIR  measurements)  is  actually  the  sum 
of  the  effects  of  true  target  dynamics  and  atmospheric 
distortion.  Under  the  assumed  dynamics  conditions,  the 
resulting  four-state  EKF  (two  target  position  states  and  two 
atmospheric  jitter  states  describing  motion  on  the  two- 
dimensional  FLIR  image  plane)  consistently  outperformed 
correlation  trackers  by  an  order  of  magnitude  in  regard  to 
RMS  tracking  errors.  It  should  be  noted,  however,  that  an 
assumption  was  made  that  the  target  image  could  be  well 
described  analytically  as  a  two-dimensional  Gaussian  inten¬ 
sity  profile  with  circular  equal- intensity  contours.  This 
assumption  is  reasonable  only  as  long  as  the  target  is  very 
distant. 

Subsequently,  robustness  studies  (Ref:  5i  PP  45-46) 
indicated  that  the  four-state  filter  was  inadequate  when 
actual  target  dynamics  and  target  range  were  much  different 
than  that  assumed  in  its  derivation.  Thus,  adding  target 
velocity  and  acceleration  states  to  the  original  four. 


Captains  Harnly  and  Jensen  developed  an  eight-state  adaptive 
EKF  that  enabled  tracking  of  more  maneuverable  targets  at 
closer  ranges.  While  still  assuming  the  target  image  could 
be  described  analytically,  it  was  portrayed  as  a  bivariate 
gaussian  intensity  distribution  with  elliptical  equal- 
intensity  contours.  However,  provisions  were  made  to 
estimate  the  size  and  shape  parameters  of  the  elliptical 
contours  adaptively.  In  addition,  Harnly  and  Jensen  more 
accurately  modelled  spatial  and  temporal  correlations  of 
backgound  noise  to  enable  better  separation  of  image  plane 
position  offsets  due  to  atmospheric  jitter  from  those  due  to 
target  dynamics.  Overall,  the  filter  was  found  to  be  very 
robust,  even  when  tracking  maneuverable  targets  at  close 
ranges,  as  long  as  the  target  image  could  be  well  described 
analytically  as  a  bivariate  Gussian  Intensity  distribution. 

This  filter  was  then  taken  and  used  as  the  basis  for 
comparing  different  dynamics  models  as  well  as  a  multiple 
model  adaptive  algorithm  (Ref:  3).  The  dynamics  models 
considered  were  the  original  Brownian  motion  (BN)  accelera¬ 
tion  model  and  a  constant  turn-rate  (CTR)  acceleration 
model.  The  multiple  model  filter  consisted  of  a  bank  of  BM 
filters  tuned  to  handle  different  degrees  of  target 
dynamics.  Analysis  indicated  that  the  CTR  dynamics  model 
outperformed  the  other  filters  by  reducing  mean  bias  errors. 
A  major  problem  with  the  multiple  model  algorithm  was  its 
inability  to  select  one  of  its  bank  of  filters  over  the 


others  because  of  the  similarity  of  the  residuals  from  all 
filters. 

Along  another  line,  work  has  been  accomplished  to 
illustrate  the  feasibility  of  a  multiple  hot-spot  tracker 
that  does  not  assume  a  priori  knowledge  of  the  shape  of  the 
target  image  (Ref;  16,17).  Digital  signal  processing 
techniques  were  used  on  the  FLIR  data  to  determine  the 
underlying  shape  of  the  target  image.  This  reference  image, 
along  with  its  derivatives,  are  required  in  the  measurement 
update  portion  of  the  extended  Kalman  filter.  In  an  Initial 
effort  (Ref:  17),  the  reference  image  derivatives  were 
approximated  using  the  Forward-Backward  Difference  Method. 
However,  resulting  filter  divergence  problems  were  not  able 
to  be  overcome.  Since  then,  a  study  performed  by  ILt  Steven 
K.  Rogers  successfully  demonstrated  the  potential  of  the 
multiple  hot-spot  tracker  (Ref:  16).  In  this  case,  the 
derivative  property  of  the  Fourier  Transform  was  implemented 
to  determine  the  reference  image  derivatives.  However, 
since  concept  feasibility  of  a  multiple  hot-spot  tracker  was 
the  goal  of  Rogers'  research,  a  four-state  filter  was  used 
that  only  estimated  target  position  and  Jitter  variables,  as 
in  the  research  by  Mercier.  In  addition,  the  multiple  hot¬ 
spot  target  was  modelled  simply  as  a  static  image  that  would 
be  realistic  for  the  trajectory  of  a  target  flying  a  radial 
path  about  the  tracker;  not  particularly  realistic,  but  able 
to  demonstrate  concept  feasibility. 


1 .2  Problem 

This  leads  to  the  specific  objectives  of  this  research. 
The  main  goal  was  to  implement  the  digital  signal  processing 
techniques  inherent  in  the  multiple  hot-spot  tracking 
algorithm  (Ref:  16),  which  assumes  no  a  priori  knowledge  of 
the  target  image,  as  part  of  an  eight-state  extended  Kalman 
filter  that  estimates  target  velocity  and  acceleration  as 
well  as  position  and  atmospheric  jitter.  To  be  exact,  two 
dynamics  models  are  considered.  They  portray  the  FLIR  image 
plane  acceleration  as  either  (1)  a  first  order  Gauss-Markov 
process  or  (2)  a  constant  turn-rate  process.  The  former 
describes  the  time  derivative  of  acceleration  via  the 
relation 

l(t)  s  -  J.  a(t)  +  ait)  (1-1) 

■^D 

where  represents  the  correlation  time  and  )i(t)  is  a  white 

Gaussian  noise  vector.  In  contrast,  the  constant  turn-rate 
model  is  defined  by  replacing  Eq  (1-1)  with 

a(t)  s  -«2it(t)  +  ii(t)  (1-2) 

where  the  parameter  u  is  the  target  image  turn-rate  and  can 
be  expressed  as 


U(t)  X  A(t)| 

U(t)|2 


(1-3) 
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The  details  of  these  models  can  be  found  in  Chapter  IV; 
however,  it  should  be  noted  that  the  purpose  of  comparing 
the  two  is  to  see  whether  the  improvement  expected  in  the 
performance  of  the  constant  turn-rate  model  is  worth  the 
additional  on-line  computation  required  due  to  the  nonlinear 
dynamics  of  Eqs  (1-2)  and  (1-3)  instead  of  the  linear  time- 
invariant  dynamics  associated  with  Eq  (1-1). 

In  order  to  test  the  effect  of  the  digital  signal 
processing  techniques  on  tracker  performance  thoroughly, 
another  objective  of  this  research  was  to  simulate  a 
realistic  changing  multiple  hot-spot  image.  Extensive 
consideration  was  given  to,  the  dynamic  sizes,  shapes,  and 
spatial  inter-relationships  of  the  hot-spots  on  the  image 
plane.  Also  of  Importance  was  simulating  the  disappearance 
of  portions  of  the  target  image  due  to  obscurations  of  parts 
of  the  target  from  the  sensor  by  other  portions  of  the 
target  Itself. 

Whatever  shape  the  target  image  displays,  it  is 
critical  that  the  extended  Kalman  filter  obtain  an  accurate 
reference  image,  li[i(ti),  t^]  ,  as  well  as  the  derivatives 
of  that  image,  iic£(ti),  ti)  =  3ll[£(ti),  til/aA  »  with 
respect  to  the  states.  After  propagating  its  state 
estimates  forward  from  one  sample  time  to  the  next,  the 
filter  processes  the  reference  image,  along  with  the 
measurement  vector,  in  order  to  produce  an  updated  state 
estimate  using  the  equation 
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+  K(ti)[2(ti)  -  h(x(tx),ti)] 


(1-4) 


where 

£(t^)  =  estimated  state  vector  after  incorporation 
of  the  measurement  of  time  tj, 

£(t^)  =  estimated  state  vector  after  propagation 
from  the  previous  measurement  update  to 
time  tj^ 

=  Kalman  filter  gain 

=  64-dimensional  measurement  vector  of  the 
average  intensities  of  the  pixels  within 
the  8x8  field  of  view  of  the  FLIR  sensor 


ll(i(ti),ti)  =  nonlinear  intensity  function  of  the 

target  image  at  time  t^  as  a  function 
of  the  state  estimate. 

The  block  diagram  shown  in  Figure  1  illustrates  the 
data  processing  algorithm  used  in  this  research. 
Essentially,  there  are  two  parallel  data  processing  paths  in 
regard  to  the  FLIR  intensity  measurements.  In  the  lower 
path,  the  8x8  array  of  intensity  measurements  are  rearranged 
by  rows  into  a  single  64x1  measurement  vector,  i(ti)  •  Then 
the  eight-state  extended  Kalman  filter  uses  the  nonlinear 
and  linearized  intensity  functions  provided  by  the  upper 
path  in  order  to  produce  an  updated  state  estimate,  £(t^)  . 
Then  using  its  internal  dynamics  rnod^l,  the  filter 
propagates  the  state  estimate  forward  in  time  to  produce 
£(tj’^l)  .  The  position  components  of  this  vector  resulting 
from  target  dynamics  are  then  fed  to  a  controller  in  order 


to  position  the  FLIP  so  that  its  center  will  be  located  at 
the  filter-predicted  location  of  the  target  at  the  next 
sample  time.  The  updated  and  propagated  state  estimates  are 
also  provided  to  the  upper  data  processing  path  for  use  in 
determining  the  centered  nonlinear  and  linearized  intensity 
functions. 

Specifically,  the  first  step  in  the  upper  path  is  to 
take  the  two-dimensional  Fourier  Transform  of  the  FLIP 
measurement  data.  However,  now  a  24x24  array  is  processed 
(as  opposed  to  an  8x8  array)  in  order  to  reduce  edge 
effects,  aliasing,  and  leakage  conditions  involved  when 
transforming  finite  sequences  (Pef;  17,  P  18)  .  Also, 
rather  than  simply  pad  the  data  with  zeros,  as  is  often  done 
in  engineering  practices,  actual  data  Is  used.  It  would  be 
appropriate  to  pad  with  zeros  if  the  image  intensity  at  the 
edges  of  the  field  of  view  were  essentially  zero.  However, 
since  this  is  often  not  the  case,  padding  with  zeros 
Introduces  artificial  edge  effects.  The  luxury  of  being 
able  to  pad  with  data  is  available  in  this  application  since 
the  field  of  view  occupies  only  a  small  portion  of  a  much 
larger  measurement  array. 

Since  the  state  estimates  that  the  Kalman  filter  feeds 
to  the  controller  are  only  Intended  to  zero  out  the  effects 
of  predicted  target  dynamics,  the  observed  target  image  is 
expected  to  be  offset  from  the  center  of  the  field  of  view 
by  atmospheric  Jitter  plus  an  amount  due  to  the  imperfect 
propagation  of  the  dy^iamlc  states.  In  order  to  acquire  the 
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effect  of  a  centered  image  in  the  original  spatial  domain, 
the  Fourier  Transform  of  the  measurement  data  is  multiplied 
by  a  negating  phase  shift  in  the  frequency  domain.  The 
appropriate  phase  shift  is  determined  by  employing  the  Shift 
Theorem  along  with  the  filter's  updated  state  estimate  as 
determined  by  Eq  (1-4).  This  produces  the  negating  shift 
which  is  the  complex  conjugate  of  the  linear  phase  shift 
that  corresponds  to  the  image  offset  expected  in  the  space 
domain. 

Once  the  image  is  centered,  inter-frame  smoothing  of 
sequential  transformed  images  is  performed  in  order  to 
reduce  the  effects  of  noise  corruption  (i.e.,  to  make  the 
underlying  target  image  more  obvious  based  upon  the  idea 
that  the  target  intensity  pattern  will  not  change  as  much, 
from  one  sample  time  to  the  next,  as  will  the  noise).  This 
is  accomplished  through  the  use  of  an  exponential  smoothing 
algorithm.  The  centered  and  smoothed  data  is  then  differen¬ 
tiated  with  respect  to  the  Kalman  filter  position  states  by 
employing  the  Derivative  Property  of  the  Fourier  Transform. 
This  produces  the  frequency  domain  representation  of  the 
linearized  intensity  function, 

Ultimately,  the  nonlinear  and  linearized  intensity 
functions  are  to  be  used  in  updating  the  state  estimate 
after  the  next  measurement.  Therefore,  they  must  first  be 
evaluated  in  terms  of  the  propagated  state  estimate. 

Since  it  is  assumed  that  the  FLIR  will  be  centered 
at  the  predicted  position  due  to  target  dynamics,  the  Shift 


Theorem  is  applied  to  each  of  the  intensity  functions  to 
produce  a  shift  equivalent  to  only  the  atmospheric  states. 
Finally,  after  evaluating  the  inverse  Fourier  Transform  of 

the  results,  li[£(ti:^l),  ti+i]  and  H  [Jt  ),  ti+i  ]  are  ready 
for  use  by  the  extended  Kalman  filter  in  processing  the  next 
measurement  frame. 


£LX£«  Although  data  is  generated  in  the  computer 
simulation  in  this  research,  it  is  assumed  that  real  data 
would  be  available  as  the  outputs  of  a  FLIR  sensor.  The 
FLIR  produces  a  frame  of  data  every  thirtieth  of  a  second 
(30  Hz  frame  rate).  Each  frame  consists  of  about  500x400 
pixels  (picture  elements)  of  information.  However,  only  8x8 
arrays  ("tracking  windows")  for  measurement  updating  and 
24x24  arrays  for  data  processing  are  manipulated  in  this 
research  in  order  to  limit  computational  and  storage 
requirements  (Ref:  5,  p  4).  Changing  the  field  of  view, 
i.e.,  changing  the  size  of  the  tracking  window,  is  a 
realistic  possibility  for  handling  harshly  maneuvering 
targets;  however,  this  aspect  is  not  investigated  in  this 
research. 

Background  Noise.  The  background  noise  that  corrupts 
the  FLIR  measurements  is  modelled  as  a  spatially  correlated 
Gaussian  process.  Although  different  physical  backgrounds 
will  result  in  different  spatial  correlations,  real  data 
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ana]/^sis  (Ref:  5)  has  indicated  that  a  reasonable  model  of 
the  spatial  correlation  is  a  decaying  exponential  that  is 
non-zero  for  pixel  distances  that  include  the  first  and 
second  nearest  neighbors  (i.e.,  the  correlation  function 
drops  an  order  of  magnitude  exponentially  in  a  distance 
equal  to  two  pixels). 

Ground  Since  the  FLIR  is  part  of  a  ground  based 

system,  mirror  and  base  vibrations  are  assumed  negligible 
and  thus  make  no  contribution  to  pointing  errors. 

Since  the  FLIR,  the  laser,  and  the 
controlling  subsystem  form  a  closed  loop  system,  it  is 
assumed  that  the  pointing  system  is  perfect.  That  is,  the 
FLIR/laser  can  be  pointed  to  whatever  spot  the  tracker 
commands  within  the  time  available  between  measurements. 


Q^erview 


Immediately  following  this  section  is  Chapter  II  which 
describes  the  data  processing  techniques  employed  in 
Figure  1  in  more  detail.  This  is  followed  by  the  truth 
model  development  in  Chapter  III,  which  presents  the  mathe¬ 
matical  models  used  to  represent  the  real  world  so  that  a 
performance  analysis  of  the  filters  can  be  conducted. 
Chapter  IV  presents  the  two  different  filter  models  studied 
in  this  research:  the  first  order  Gauss-Markov  and  the 


constant  turn-rate  models.  Also  in  Chapter  IV  is  a 
discussion  of  estimation  of  the  dynamic  driving  noise  in  the 
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system.  This  is  followed,  in  Chapter  V,  by  a  description  of 
the  performance  analysis  methodology  used  to  test  the 
filters  developed  in  Chapter  IV  against  the  truth  model 
described  in  Chapter  III,  Chapter  VI  presents  the  results 
of  the  performance  analysis,  and  this  is  followed  by 
conclusions  and  recommendations  in  Chapter  VII. 


II. 


In  order  to  track  a  wide  variety  of  targets  which  may 
exhibit  unknown  and/or  changing  sizes  and  shapes  on  the  FLIP 
image  plane,  the  EKF  must  be  able  to  generate  an  accurate 
intensity  profile  of  the  target  image,  hCiCtJ),  tj^l  »  as 
well  as  the  derivative  of  that  profile,  iiCxCtp,  tj^]  ,  with 
respect  to  the  states.  It  is  the  information  within  these 
two  functions,  evaluated  at  the  current  state  estimate,  that 
the  EKF  processes  along  with  noise  corrupted  FLIP  measure¬ 
ments  in  order  to  compute  updated  state  estimates,  as  in  Eq 
(1-4).  Specifically,  the  goal  is  to  recognize  the  true 
intensity  function  of  the  target  image  using  past  noise- 
corrupted  data  frames. 

In  theory,  it  is  possible  to  represent  all  the 
information  in  a  two-dimensional  intensity  function  by  a  set 
of  eigenfunctions  and  corresponding  eigenvalues.  However, 
an  exact  representation  could  well  require  an  Infinite 
number  of  such  functions  and  values.  Thus,  a  well  suitable 
transformation  must  be  determined  that  is  not  overly 
cumbersome  yet  yields  an  accurate  representation  of  patterns 
within  the  intensity  data. 


One  possible  method  is  known  as  the  Karhunen-Loeve 
Transformation.  This  transformation  generates  a  new 
coordinate  space  with  totally  uncorrelated  image  components 


based  on  the  properties  of  the  spatial  autocorrelation 


kernel  (Ref:  17i  P  9).  For  an  NxN  input  matrix,  the 
eigenvalues  correspond  to  actual  variance  statistics 
projected  onto  orthogonal  eigenfunctions.  Thus,  this 
transformation  has  the  disadvantage  of  requiring  the 
manipulation  of  an  N^xN^  correlation  matrix  whose  exact 
calculation  is  often  very  difficult  to  perform. 

Alternatively,  if  the  assumptions  of  spatial 
stationarity  and  a  space  domain  large  in  extent  are  made, 
the  Karhunen-Loeve  Transformation  provides  motivation  for 
the  use  of  the  Fourier  Transform  (Ref:  17,  p  12).  Although 
the  Fourier  Transform  does  not  produce  perfect  decorrelation 
of  new  data  components,  it  is  desirable  computationally  and 
also  because  of  the  property  of  separability  that  enables 
the  two-dimensional  transform  to  be  obtained  through  simpler 
one-dimensional  operations. 


Eauriac 


As  in  the  case  of  the  one-dimensional  transform,  the 
two-dimensional  Fourier  Transform  utilizes  complex 
exponentials  as  eigenfunctions;  however,  now  two  spatial 
frequencies  (fj^  and  fy)  are  generated  which  are  related  to 
the  spatial  coordinates,  x  and  y  respectively.  Thus,  the 
Fourier  Transform  of  a  complex-valued  function  of 
Independent  variables,  i(x,y),  can  be  regarded  as  a  decompo¬ 
sition  of  that  function  into  a  linear  combination  of 


elementary  functions  of  the  form  exp[j2’f(xfx  + 

(Ref;  4,  p  8).  The  transform  will  be  represented  as  F(g) 

and  defined  by 


F(g)  =  G(fx  ,  fy) 


=  J  i(x,y)exp[-j2ir(xfx  +  yfy)]dxdy  (2-1) 


where 


S(fx,fy)  =  Frequency  Spectrum 


g(x,y)  =  Function  in  Spatial  Domain 


^x»fy  *  Spatial  Frequencies 


x,y  s  Spatial  Variables 


The  transform  Itself,  also  a  complex-valued 
function,  but  of  the  Independent  spatial  frequencies,  fx  3”** 
fy. 

In  order  for  any  transform  to  be  useful,  its  inverse 
must  also  exist.  The  inverse  Fourier  transform  of  a 
function  5(fj5,fy)  is  defined  as 


F-Ug)  =  g(x,y) 

=  f  C(fx,fy)  exp[j2ir(xfx  ♦  yfy)]dfxdfy  (2-22) 
where  the  terms  are  as  defined  above.  The  equations  (2-1) 
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and  (2-2)  are  defining  relations  for  the  continuous  Fourier 
Transform;  however,  in  this  research  data  is  available  as  a 
finite  number  of  discrete  values.  Thus  it  is  necessary  to 
process  the  data  using  the  two-dimensional  finite  Discrete 
Fourier  Transform  (DFT).  The  development  of  the  DFT  can  be 
found  in  Digital  Signal  Processing  by  Oppenheim  and  Schafer 
(Ref:  15)  with  the  result  as  presented  here.  Thus  for  an 
NxN  set  of  discretized  intensity  values, 


N-1  N-1 

G(f3j  ,fy)  =  z  I  g(x,y)exp[-j(2ir/N)(xfjf  +  yfy)]  (2-3) 
xsO  y=0 


with  the  corresponding  inverse  Discrete  Fourier  Transform 


given  by 


N-1  N-1 

g(x,y)  s  (1/n2)  r  i  G(fjj,fy)exp[ j(2w/N)(xfx  +  yfy)] 


fx=0  fy=0 


(2-4) 


where  g(x,y)  and  G(fj5,fy)  now  represent  discrete  NxN  arrays. 
As  in  the  continuous  case,  the  discrete  transform  is 
separable  and  can  be  obtained  through  simpler  one- 
dimensional  operations. 

For  implementation  in  the  computer  software,  the  DFT  is 
replaced  by  a  more  efficient  version  known  as  the  Fast 
Fourier  Transform  (FFT).  The  FFT  and  its  inverse  (IFFT)  are 
performed  by  subroutine  FOURT  (see  Appendix  G).  FOURT 
utilizes  what  is  known  as  the  Cooley-Tukey  method  of 


calculating  the  FFT  of  multi-dimensional  arrays.  Further 
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information  on  the  routine  can  be  found  in  the  commented 
software  itself;  or  for  more  detail,  see  (Ref:  2,  pp  76-9) 
or  Ref:  16,  pp  131-45). 


In  order  to  update  the  state  equations,  the  extended 
Kalman  filter  must  generate  a  representation  of  the  target's 
intensity  pattern  on  the  FLIR  image  plane.  Several  things 
work  against  the  filter  being  able  to  generate  an  accurate 
profile.  They  Include  the  presence  of  noise  corruption 
within  the  raw  measurements  and  the  fact  that  a  realistic 
target  image  will  display  continuous  size  and  shape  changes. 
However,  at  reasonable  measurement  rates,  even  a  dynamic 
image  will  not  vary  as  fast,  from  sample  period  to  sample 
period,  as  does  the  corruptive  noise.  Thus,  interframe 
smoothing  can  be  utilized  to  reduce  the  effects  of  unwanted 
noise. 

One  method  that  is  traditionally  used  to  combat  noise 
effects  is  the  moving  average  technique.  This  technique  is 
simply  an  average  of  the  K  most  recent  frames  of  data  where 
the  value  K  is  chosen  to  reflect  how  long  past  frames  will 
be  considered  in  the  current  average.  However,  KN^  storage 
locations  are  required  in  order  to  average  K  NxN  data 
arrays.  A  less  costly  technique  is  the  exponential 
smoothing  algorithm  which  is  represented  by  the  following 
equation  (Ref:  1): 


y(t)  =  oy(t)  +  (l-a)y(t-l) 


(2-5) 


where 

y(t)  =  the  most  recent  averaged  frame 
y(t)  =  the  current  data  frame 
y(t-1)  s  the  previos  averaged  data  frame 

a  =  the  smoothing  constant  such  that  0  ^  a 

As  indicated,  the  smoothing  constant,  a,  can  vary  anywhere 
from  0  to  1 ,  inclusive,  depending  on  the  weight  that  is  to 
be  put  on  the  current  data  frame.  For  static  and  slowly 
varying  images,  it  is  desirable  to  use  a  steady  state 
smoothing  constant  that  is  of  very  small  magnitude  in  order 
to  obtain  maximum  benefit  from  the  smoothing  process. 
However,  such  a  value  would  have  to  be  somewhat  larger  for 
more  dynamically  changin’g  images,  since  there  is  a  need  to 
weight  the  current  data  more.  A  tradeoff  analysis  must  be 
conducted  in  order  to  determine  a  smoothing  constant 
suitable  for  all  degrees  of  image  variation  to  be 
encountered. 

For  implementation,  it  is  appropriate  that  the 
smoothing  constant  change  during  Initial  time  frames. 
Specifically,  o  s  1/K  for  K  =  1,2,3...  until  the  desired 
steady  state  value  is  reached.  In  addition,  the  smoothing 
process  Itself  can  be  performed  in  either  the  spatial  or 
frequency  domains.  Equivalent  results  have  been  achieved 
using  either  approach  (Ref:  16,  p  99).  However,  since 
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smoothing  in  the  frequency  domain  required  fewer 
transformations,  and  thus  fewer  numerical  errors,  it  was 
chosen  for  use  in  this  research. 

In  summary,  it  should  be  noted  that  the  exponential 
smoothing  technique  uses  only  2N^  memory  locations  to 
generate  the  most  recent  averaged  data  frame,  y(t),  compared 
to  the  KN2  locations  required  by  the  moving  average 
technique.  In  addition,  y(t)  contains  some  information  from 
all  previous  data  frames  although,  due  to  repeated  applica¬ 
tion  of  the  weighting  factor,  initial  frames  have  much  less 
effect  on  the  averaged  data  than  the  current  frame. 

2.4  Shifting  Pcopfir-fcx 

In  order  to  determine  the  underlying  intensity  profile 
of  the  target  image  from  noise  corrupted  data,  exponential 
smoothing  is  used  as  discussed  above  in  order  to  determine 
which  portion  of  the  observed  profile  is  common  to  all  data 
frames.  However,  before  this  can  be  accomplished,  the 
pattern  must  first  be  centered  since  the  pattern  will 
experience  different  shifts  from  frame  to  frame.  It  is 
towards  this  end  that  the  shifting  property  of  the  Fourier 
Transform  is  used,  along  with  the  filter’s  estimate  of  the 
target  location  on  the  image  plane. 

The  shift  theorem  states  that  the  translation  of  a 
function  in  the  space  domain  introduces  a  linear  phase  shift 
in  the  spatial  frequency  domain  (Ref:  4,  p  9)«  The  Fourier 
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Transform  views  a  finite  length  sequence  of  length  N  as  a 
single  period  of  a  corresponding  periodic  sequence  of  period 
N.  Therefore,  a  shift  on  a  finite  length  discrete  one¬ 
dimensional  sequence  can  be  thought  of  as  a  rotation  of 
samples  within  the  basic  interval  of  the  sequence.  That  is, 
as  samples  are  shifted  out  one  side  of  the  Interval, 
identical  samples  enter  the  other  side  (Ref:  15,  p  102). 
Such  a  shift  is  often  termed  a  cylindrical  shift  since  if 
the  samples  were  to  lie  on  the  circumference  of  a  cylinder  a 
linear  shift  would  correspond  to  a  rotation  of  the  cylinder. 

These  ideas  can  be  extended  to  the  case  of  a  finite 
area  two-dimensional  sequence.  In  relation  to  Eq  (2-1)  a 
translation  of  the  complex  valued  function,  g(x,y),  in  the 
space  domain  results  in  the  following  Fourier  spectrum  in 
the  spatial  frequency  domain 

F(g(x-a,y-b)  =  G(f jj,fy)exp[-j2  (af^  +  bfy)]  (2-6) 

where 

F(g(x,y))  s  G(fj5,fy) 

a  =  shift  of  the  spatial  function  in  the 
X  direction 

b  s  shift  of  the  spatial  function  in  the 
y  direction 

Equation  (2-6)  Indicates  that  the  only  difference  between 
the  original  spectrum  and  the  spectrum  corresponding  to  the 
translated  function  is  the  addition  of  a  linear  phase  shift 
that  is  proportional  to  the  magnitude  of  the  spatial 


a 


translations  in  the  x  and  y  directions.  As  a  result,  if  the 
magnitude  of  the  spatial  shift  is  known,  a  negating  phase 
shift  can  be  applied  to  the  original  transform  in  order  to 
obtain  the  transform  of  an  equivalent  but  centered  image. 
Specifically,  the  steps  to  be  performed  to  obtain  the 
centered  intensity  profile  are  as  follows: 

•  obtain  the  transform  of  the  offset  intensity 
profile  (raw  meaurements) 

•  multiply  the  transform  by  the  complex  conjugate  of 
the  phase  shift  Introduced  in  the  frequency 
domain;  this  negating  phase  shift  is  formed  using 
the  extended  Kalman  filter's  estimate  of  the  image 
location 

*  Implement  smoothing  algorithm  if  smoothing  is  to 
be  done  in  the  frequency  domain 

*  take  the  Inverse  transform  to  obtain  the  centered 
intensity  profile. 

The  equation  describing  these  steps  is 

g(x,y)  =  (F[i(x-a,y-b)  ]exp[+j2  irCafjf  +  bfy)]J 

(2-7) 

where  a,b  now  represent  the  filter's  estimates  of  the  image 
offsets  in  the  x  and  y  directions  respectively,  and,  the 
frequency  domain  smoothing  is  accomplished  prior  to  taking 
the  inverse  transform. 
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One  of  the  reasons  that  data  processing  in  the 
frequency  domain  is  so  desirable  is  because  of  the 
derivative  property  of  the  Fourier  Transform.  As  indicated 
in  the  overview,  the  extended  Kalman  filter  requires  an 
accurate  representation  of  not  only  the  nonlinear  intensity 
function,  liCxCti),  t^li  but  of  the  linearized  intensity 
function,  flCiCtj^),  t^]  s  3liCjt(ti),  ,  as  well.  Using 

the  Fourier  Transform,  differentiation  in  the  spatial  domain 
reduces  to  a  simple  multiplication  in  the  spatial  frequency 
domain.  Attempts  have  been  made  to  implement  a  simpler 
method  known  as  the  Forward-Backward  Difference  Method 
(Ref:  17).  However,  filter  divergence  problems  indicated 
the  need  for  a  better  technique.  In  contrast,  use  of  the 
Fourier  Transform  derivative  property  is  more  accurate  and 
has  been  effectively  implemented  (Ref:  16)  because  it 
utilizes  the  entire  data  array  to  compute  the  derivatives  as 
opposed  to  Just  the  values  in  the  preceding  and  subsequent 
pixels.  Analytically,  the  process  can  be  described  by 

3ll(x,y) 

3  X 


=  J2irfx  F[h(x,y)] 


(2-8a) 


r  j2nfy  F(li(x,y)] 


(2-8b) 


where  Ji(x,y)  represents  the  centered  and  smoothed  intensity 
profile.  Implementation  of  the  derivative  property  is 
accompished  in  Subroutine  DERIV  (see  Appendix  G)  where  each 
data  point  in  the  transform  domain  is  multiplied  by  (j2 
times  the  spatial  frequency  associated  with  both  that 
location  as  well  as  the  direction  of  the  desired 
derivative) . 

2 . 6  Summary 

This  section  has  presented  the  signal  processing 
techniques  behind  the  recognition  and  generation  of  the 
nonlinear,  liCiCtj),  t  ] ,  and  linearized,  HCxCt^),  t^], 
intensity  functions.  These  functions  are  required  by  the 
extended  Kalman  filter  in  the  measurement  update  portion  of 
state  estimation  (to  be  discussed  in  Chapter  IV).  To 
acquire  these  functions,  the  filter  must  process  raw 
measurement  data.  This  data  contains  the  intensity  profile 
of  the  target  which  is  corrupted  by  noise  and  is  shifted 
from  the  center  of  the  field  of  view  by  atmospheric  jitter 
as  well  as  by  filter  tracking  errors.  In  order  to  obtain 
the  desired  intensity  functions,  the  raw  data  is  first 
transformed  to  the  spatial  frequency  domain  via  the  Fourier 
Transform.  Since  the  data  is  available  only  as  discrete 
values,  the  Discrete  Fourier  Transform,  or  actually  a  more 
efficient  version  known  as  the  Fast  Fourier  Transform,  is 
used  in  the  actual  Implementation.  The  transformation 


itself  can  be  regarded  as  the  decomposition  of  the  input 
array  into  a  linear  combination  of  complex  exponential 
eigenfunctions  which  indicate  the  spatial  frequency  content 
of  the  signal. 

Once  the  data  is  expressed  in  the  spatial  frequency 
domain,  smoothing  is  performed  in  order  to  reduce  the 
effects  of  noise.  An  exponential  smoothing  algorithm  was 
chosen  for  this  inter-frame  smoothing  process  since  it 
requires  much  less  memory  compared  to  other  techniques.  The 
algorithm  is  flexible  in  the  sense  that  the  steady-state 
smoothing  constant  can  be  chosen  small  to  take  full 
advantage  of  the  smoothing  process  when  the  target  image 
intensity  distribution  is  relatively  static  compared  to  the 
rate  at  which  measurements  are  made.  In  contrast,  the 
smoothing  constant  should  be  somewhat  larger  for  more 
dynamic  image  variations. 

Since  the  intensity  pattern  that  is  common  to 
successive  data  frames  will  have  experienced  different 
spatial  offsets,  it  must  be  centered  each  frame  prior  to 
smoothing.  This  is  accomplished  via  the  Shifting  Theorem  of 
the  Fourier  Transform.  Using  this  theorem,  the  offset  in 
the  Intensity  profile  can  be  corrected  by  an  amount  equal  to 
the  filter's  estimate  of  the  atmospheric  Jitter. 

Once  the  image  has  been  centered  and  smoothed,  the 
spatial  derivatives  of  the  profiles  can  be  generated  by 
Implementing  the  Derivative  Property  of  the  Fourier 
Transform  in  the  frequency  domain.  These  derivatives  are 
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required  in  order  to  determine  the  linearized  intensity 
functions  which,  along  with  the  centered  nonlinear  intensity 
function,  are  to  be  evaluated  at  the  current  state  estimate 
for  use  in  further  processing  by  the  filter.  Since  the  high 
energy  laser,  and  thus  the  center  of  the  field  of  view,  is 
to  be  located  at  the  filter's  best  estimate  of  the  target's 
location,  the  resulting  Intensity  functions  should  be  offset 
from  the  center  by  an  amount  equivalent  to  the  estimated 
atmospheric  jitter  states.  This  is  accomplished  by  again 
Implementing  the  Shift  Theorem  prior  to  taking  the  inverse 
FFT.  The  final  intensity  functions  are  then  used  by  the 
extended  Kalman  filter  during  the  next  measurement  update. 


III.  Truth  Model 


3.1  Introduction 

In  most  large  scale  design  work,  it  Is  not  feasible  to 
build  and  test  a  product,  in  the  real  world,  immediately 
after  completion  of  the  initial  design.  However,  some  means 
of  evaluation  must  be  used  to  determine  if  a  design  is 
suitable  for  eventual  implementation.  Thus  in  this 
research,  a  performance  (sensivity)  analysis  is  conducted 
(see  Chapter  V)  to  determine  how  well  the  filter  designs 
might  be  expected  to  perform  in  the  real  world.  Such  an 
anlysls  requires  the  replacement  of  the  real  world  with  a 
"truth  model"  which  represents  the  best,  most  complete 
mathematical  representation  of  the  real  world  available  to 
the  designer.  This  chapter  presents  the  various  components 
of  the  truth  model  used  to  represent  environmental  charac> 
teristlcs  such  as  atmospheric  Jitter  effects,  target 
dynamics,  as  well  as  FLIR  and  background  noises.  Extensive 
consideration  is  also  given  to  simulating  the  measurement 
vector,  i(tj^),  of  a  realistic  target  image. 

The  initial  two  sections  (3*2  and  3.3)  describe  the 
image  plane  translation  of  the  target  image  intensity 
function  due  to  atmospheric  Jitter  as  well  as  deterministic 
target  dynamics.  The  following  section  (3*4)  then 
formulates  the  state  space  representation  of  the  entire 
system  and  describes  its  propagation  in  time.  Section  3>5 


i 


i 


»  ^ 
*  J 


describes  the  pixel  by  pixel  creation  of  the  measurement 
data  for  a  target  image  with  M  hot-spots.  This  is  followed 
in  Section  3«6,  by  a  description  of  the  size,  shape,  and 
spatial  inter-relationship  of  the  M  hot-spots  involved  in  a 
dynamic  image.  Finally,  the  spatial  correlation  model  of 
the  background  noise  is  presented  in  Section  3>7. 


3.2 


Disturbance  Madfil 


As  a  result  of  atmospheric  phase  front  distortion,  the 
intensity  distribution  of  radiated  wavefronts  undergoes 
translational  position  changes  with  time  on  the  FLIR  image 
plane.  An  accurate  representation  of  these  turbulent 
effects  was  developed  by  The  Analytic  Sciences  Corporation 
(TASC)  based  on  data  supplied  by  the  Air  Force  Weapons 
Laboratory  (Ref;  6).  The  resulting  power  spectral  density 
(PSD)  representation  can  be  approximated  by  the  power 
spectral  density  that  is  characteristic  of  the  output  of  a 
third  order  shaping  filter  driven  by  zero-mean,  white, 
Gaussian  noise,  as  shown  in  Figure  2. 


“A 

K  A  b2 

(s  A)  (s  -t-  B) 

A  =  14, 14  rad/sec 
B  =  659 *5  rad/sec 


Figure  2.  Third  Order  Shaping  Filter 
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=  Zero-mean,  white,  Gaussian  noise 


A,B  =  Break  frequencies 

K  r  System  gain  -  adjusted  to  obtain  desired  RMS 
jitter 

=  System  output  that  has  the  desired  PSD 

Since  the  effects  of  atmospheric  jitter  are  independent 
of  direction  on  the  FLIR  image  plane,  the  resulting  planar 
motion  can  be  modelled  as  the  output  of  two  such  shaping 
filters  (corresponding  to  motion  in  each  of  the  x  and  the  y 
directions  on  the  FLIR  plane).  Thus,  the  effects  of  the 
atmosphere  can  be  described  by  a  stochastic  differential 
equation  of  the  form: 

iA(t)  =  EA(t)^A(t)  ♦  fiA(t)MA(T)  (3-1a) 

lA(t)  =  ilA(t)AA^t)  (3-1b) 

where: 

^a(^)  =  atmospheric  noise  states  (three 
for  each  direction;  six  total) 

£a(^)  =  atmospheric  plant  matrix 

s  the  atmospheric  noise  input  matrix 

Ua^^)  =  two  dimensional  vector  of  zero-mean, 
white,  Gaussian  noise  Inputs 


such  that: 


=  the  desired  output  of  the  system 
(shift  in  FLIR  coordinates) 

li^(t)  =  the  system  output  matrix 

ECaA(t)]  =  Q 

and 


C 


Et‘tA(t)llA(t  +t))  =  fiA(t)«(’)  (3-2) 

in  the  above  equation  is  the  atmospheric  noise  covariance 
kernel  descriptor  and  is  often  assumed  constant  for  off-line 
tuning.  The  results  can  then  be  implemented  in  the  actual 
filter  as  constants  or  as  the  initial  values  of  a  time 
varying  descriptor.  The  latter  is  appropriate  in  two 
instances:  during  the  acquisition  phase  and  when  adaptive 
on-line  tuning  is  implemented. 

Using  the  Jordan  canonical  form  to  represent  the  system 
description  of  atmospheric  turbulence  in  a  single  direction 
(Ref:  12,  pp  73-75),  Equation  (3-1)  corresponding  to  the  x 
direction  becomes: 


-A  0  0 

*Ax1 ( t) 

Gl 

iAx(t)  = 

0  -B  1 

XAx2(t) 

+ 

G2 

WAx^t^  (3-3) 

0  0  -B 

*Ax3(t) 

G3 

w  m 
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where  A,B  are  the  break  frequencies  and 


KAB^ 

Gi  =  2 

(A-B) 


Gp  =  -Gi 


(3-4) 


G3  =  (A-B)Gi 

Thus  both  and  are  constant  matrices.  This  yields  an 
output  equation  of  the  form: 


yAx(fc)  =  C  1  1  03  XAx(t) 


(3-5) 


The  general  solution  of  the  six  states  of  Eq  (3-1a)  between 
one  sample  time  and  the  next,  i.e.,  for  all  t  e 


iA(t)  =  iA(t,ti)iA<ti) 


ti 


(3-6) 


where  lj^(t,tj^)  is.  the  state  transition  matrix  for  the 
atmospherics  which  must  satisfy  the  matrix  differential 
equation: 


<3-7) 


with  the  boundary  condition:  i(tj[,ti)  =  !•  When  the  plant 
matrix  is  constant,  the  state  transition  matrix  becomes  a 
function  of  At  =  ti^,i  -  tj  for  a  fixed  sampling  time.  More 


specifically , 


^A(ti+i,ti)  =  iACH)  (3-8) 

Thus  for  the  plant  in  Equation  (3-3)  the  state  transition 
matrix  for  distortion  in  the  FLIR  x  direction  is: 

e-AAt  0  0 

0  Ate" 

0  0  e® 

An  identical  result  follows  for  distortion  in  the  FLIR  y 
direction.  For  digital  computer  implementation  it  is 
necessary  to  develop  equivalent  di screte- t i me 
representations  for  the  continuous-time  processes  (Ref:  7). 
Toward  this  end,  a  discrete-time  noise  process  can  be 
defined  with  statistics  equivalent  to  those  of  the 

stochastic  Integral  in  Eq  (3-6),  i.e. 

ti+1 

“Ad^ti)  =  f  ^A(ti+i,  T)fiA(T)HA(  T)dT  (3-10) 

ti 


such  that  ECiiAd^^i^^  "  ^ 


t  1  f 


ti+1 


f  ,  T)fiA<  t)Qa(  "tJCaC  T)Al(ti+i ,  T)dT  =  QAd(ti) 

ti 


(for  =  tj) 

=  £  i  tj) 


(3-11) 


Therefore,  a  discrete-time  equation  equivalent  to  Eq  (3-6) 
can  be  written: 

c _ 

XA(ti+l)  =  ♦A(ti+1 ,ti)AA(ti)  +  V5AdMAd(ti^  (3-12) 
c 

where  V^Ad  is  the  lower  triangular  Cholesky  square  root 
of  flad  7)f  and, 


ECH'Ad(ti)]  =  fl 


(3-13) 


^J*'Ad(ti)ii'Ad<ti)]  =  l5ij 

Note  that  the  properties  of  YflAdH'Ad  identical  to 

those  of  BAd  in  Eqs  (3-10)  and  3-11).  The  details  of  the 
exact  integration  of  (3-11)  are  shown  in  Appendix  A. 

3.3  Target  dynamic 8  Model  -  Traiectorv  Cfineraiion 


The  truth  model  for  the  target  dynamics  is  a 
continuous-time  deterministic  model  used  to  describe  a 
highly  maneuverable  aircraft  or  missile.  It  is  desired  that 
the  target  simulations  be  as  realistic  as  possible  yet 
remain  computationally  feasible  for  on-line  operation. 


Therefore,  in  this  research,  the  performance  of  the  filter 
will  be  tested  against,  basically,  three  types  of  maneuvers: 

(1)  straight  line  propagation 

(2)  constant  roll-rate  maneuvers 

(3)  constant  G,  constant  speed  turns 

Initially,  these  maneuvers  will  be  examined  separately 
to  note  their  effects  on  the  intensity  distributions  of  the 
multiple  hot-spot  target  on  the  FLIR  image  plane  and  on 
tracking  performance.  Then,  combinations  of  these  maneuvers 
will  be  pieced  together.  A  typical  trajectory  might  involve 
a  straight  line  path  while  undergoing  a  constant  roll-rate 
followed  by  a  constant  G  pull-up. 

The  assumed  target  geometry  will  be  described  in  detail 
in  a  subsequent  section  (FLIR  Measurements);  however,  it 
should  be  noted  that  the  center  of  gravity  of  the  vehicle 
(about  which  the  rolls  will  take  place)  is  assumed  to 
coincide  with  the  centroid  of  the  FLIR  image  when  projected 
onto  the  FLIR  plane.  Thus,  a  constant  roll  maneuver,  while 
on  a  straight  line  trajectory,  will  not  affect  the  dynamics 
of  the  centroid.  This  is  not  the  case,  however,  when  the 
craft  is  undergoing  a  rolling,  G-pulling  maneuver. 

All  maneuvers  will  be  simulated  by  implementing  a 
predetermined  deterministic  flight  path  in  inertial  space. 
The  target's  true  location  is  then  projected  onto  the  FLIR 
image  plane  for  comparison  with  filter  estimates  in  order  to 
evaluate  filter's  tracking  performance.  The  vehicle's 


flight  path  can  be  generated  through  the  use  of  control 
inputs  to  the  truth  model  dynamics  similar  to  the  method 
used  by  Captains  Harnly  and  Jensen  (Ref:  5).  One  major 
difference  is  that,  in  this  research,  azimuth  and  elevation 
acceleration  inputs  are  generated  for  use  in  propoagating 
the  true  position  as  well  as  determining  the  performance  of 
the  filter's  acceleration  estimate.  Thus,  a  convenient 
means  of  simulating  a  prescribed  position  time  history  is 
through  the  use  of  the  following  vector  dynamics 
differential  equation: 


ioCt)  =  fiDilD(t)  = 


«(t) 

B(t) 


(3«14) 


Here,  o(t)  and  8(t)  describe  the  time  varying  azimuth  and 
elevation  velocities  in  the  inertial  reference  frame.  Also, 

=  1  is  the  control  input  matrix.  At  this  point,  a 
discrete  representation  of  (3-14)  can  be  made  over  the 

interval  Cti,ti+i]  in  terras  of  the  target  acceleration  and 
velocity  at  time  ti^ 


=  iD^ti)  +  ioCti)  &t  +  iD(ti)  At2/2  (3-15) 

which  is  valid  to  the  degree  that  the  accelerations  jto 
constant  over  a  given  sample  period. 

At  any  one  instant  in  time  the  geometry  of  the  target 


in  the  Inertial  reference  frame  might  appear  as  shown  in 
Figure  3. 


elevation 

\ 


^azimuth 


4^. 


X 

azimuth 


Figure  3.  Inertial  Reference  Frame 


where, 


Xj,Yi,Zi  =  inertial  axes 


p  :  range  to  target  from  inertial  origin 
vj  inertial  velocity 


>'h  =  horizontal  range 


a  s  azimuth  angular  displacemsit  from  Xj  about  Yj 

0  =  elevation  angular  displacement  from  the 

Xi  -  Zi  plane  about  the  Zazimuth  axis  of  Fig  3 


and, 


2 

oi(t)  =  [  (xi(t)zi(t)-xi(t)zi(t)  )rh-2(xi(  t)xi(t) 


+  zi(t)zi(t)  )  (xi(t)zi(t)-xi(t)zi(t)  )  ]/rh(  >"3^/3602) 

(3-18) 


2  2  2 

where  =  xj  +  zj  .  The  results  of  Eqs  (3-16),  (3-17), 
and  (3-18)  can  be  converted  from  units  involving  radians  to 
pixels  by  dividing  by  (20  urad/pixel)  since  the  8x8  pixel 
field  of  view  (FOV)  is  assumed  to  represent  a  region  of  160 
urad  X  160  urad. 

Similarly,  Figure  5  displays  the  geometry  involved  in 
calculating  the  elevation,  elevation  velocity,  and  elevation 
acceleration.  The  plane  shown  is  perpendicular  to  the  Xj_Zi 
plane  and  contains  the  Yx  axis,  p  ,  and  rh* 


Figure  5.  Elevation  Geometry 
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222  1/2 
p  =  range  =  [xjCt)  +  yi(t)  +  zjCt)] 


Therefore, 


2  2,  ,1/2 

horizontal  range  =  [xi(t)  +  zi(t)] 


B  (t)  =  tan-1 [yj(t)/rh(t)] 


(radians)  (3-19) 


which  implies, 


B(t)  =  [rjj(t)yi(t)-yi(t)rh(t)]/P^(t)  (rad/sec)  (3-20) 


where. 


«*h(t)  =  [xi(  t)xi(  t)+zi(t)2i(  t)  ]/rh(t)  (m/sec)  (3-21) 


In  addition. 


B(t)  s  { p2(t)  [rjj(t)yi(t)-yi(t)rh(t)  ] 

-[rh(t)yi(  t)-yi(t)rh(  ]  (2p(t)  p(  t))}/p^(t) 

(rad/sec2)  (3-22) 


where. 


rh(t)  =  {[xi(t)xi(t)+x^(t)-i'Zi(t)zi(t)+zi(t3rh^1^^ 

-*rh(  t )  Cxi(  t  )xi(t)+zi(  t)  zi(  t )  ]  }/rh^  (®/ sec2) 

(3-23) 


and. 


p(t)  s  [xj(t)xi(t)+yi(t)yi(t)+zi(t)zi(t)]/p (t)  (m/sec) 


The  quantities  B(t),  B(t),  and  B(t)  can  also  be  converted  to 
units  involving  pixels  by  dividing  by  (20  rad/pixel). 


Returning  to  Eq  (3-15)  the  general  solution  of  the 


dynamics  differential  equation  is: 

t 

ii-Dit)  =  ti)XD(l^i)  +  7  (3-25) 

ti 

where 


=  initial  time 


AD(t,T)  =  state  transition  matrix  for  vehicle  dynamics 
gjj(T)  =  the  control  input  matrix 

Ud(t)  =  the  control  function  for  the  truth  model 
dynamics 

=  [‘a(T)  ,  e(T)  I*** 

For  digital  computer  Implementation,  a  desirable  form  of 
Up(t)  is  one  that  assumes  piecewise  constant  accelerations 
between  sampling  times.  If  an  approximation  such  as  this  is 
reasonable,  then  a  discrete  representation  of  Eq  (3-25) 
would  be  a  function  of  discrete  time  instants.  That  is. 


=  lD^ti+1,ti)jtD(ti)  +  Bd(ti)ii(i(ti)  (3-26) 


which  is  accurate  if 


fid^ti)ud^ti) 


+  l  ,  t)BdC  t)Ud(  T)dT 


(3-27) 


Specifically,  if  the  acceleration  is  assumed  piecewise 
constant,  the  azimuth  position  due  to  target  dynamics  can  be 


propagated  as 


“(ti+i)  =  <»(ti)  +  Ata(ti)  +  (At2/2)d(ti)  (3-28) 


This,  along  with  the  corresponding  elevation  propagation, 
can  be  used  as  a  reasonable  approximation  to  the  integral  in 
Eq  (3-27).  As  a  result,  the  discrete  time  control  and 
control  input  matrices  can  be  described  as 


At  0 

0  At 


A^ 

2 

0 


0 

At2 

-1 


«(ti) 

B(ti) 

o(ti) 

B(ti) 


(3-29) 


It  should  be  noted  that  the  discrete  time  history,  XD(ti^» 

could  have  been  easily  specified  from  Eqs  (3-16)  and  (3-19); 

•  •  ••  •• 

however,  the  quantities  o,  B,  o,  and  b  were  needed  for 
filter  performance  analysis  and  when  used  in  the  manner 
shown  above,  they  adapt  well  to  a  state  space  representation 
of  the  stochastic  truth  model.  Of  course,  Eq  (3-29)  is  not 
really  expressed  in  terms  of  four  independent  inputs,  since 
a  and  a  are  Interdependent,  as  are  B  and  b  . 

Although  the  dynamics  of  the  center  of  gravity  of  the 
target  in  inertial  space  can  be  specified  via  (t)  and  (t), 
the  dynamics  of  other  points  on  the  craft  are  somewhat  more 
complicated  to  describe  during  rolling  and/or  G-pulling 
maneuvers.  Consideration  of  the  dynamics  of  such  points  is 
Important  if  a  realistic  multiple  hot-spot  image  is  to  be 
created  on  the  FLIR  image  plane  since  a  target  will  not,  in 
general,  be  sperically  symmetric.  In  this  research,  the 


^2 


target  Is  assumed  to  resemble  three  ellipsoids  of  revolution 

in  three-dimensional  space.  The  centers  of  the  ellipsoids 

are  fixed  distances  apart  and  lie  in  a  plane  containing  the 

•¥ 

velocity  vector  of  the  craft,  vj,  as  well  as  the  semi-major 
axes  of  the  ellipsoids  (see  Section  3.5  on  FLIR  Measurements 
for  more  detail). 

Thus,  when  these  ellipsoids  are  projected  onto  the  FLIR 
image  plane,  bivariate  Gaussian  elliptical  equal-intensity 
contours  will  appear  with  the  center  of  each  ellipsoid 
projecting  onto  the  maximum  intensity  point  of  its 
corresponding  FLIR  image  plane  intensity  distribution.  In 
addition,  the  one-sigma  values  of  the  bivariate  Gaussian 
Intensity  distributions  will  be  proportional  to  the  semi- 
minor  and  semi-major  axes  of  the  corresponding  target 
ellipsoids.  To  keep  track  of  the  location  of  the  maximum 
intensity  points  o>f  these  distributions,  the  following 
planes  and  frames  are  defined  in  relation  to  the  inertial 
reference  frame. 

Target  plane  -  The  plane  formed  by  the  velocity  vector, 
vj,  of  the  target  and  the  centers  of  the  ellipsoids  of 
revolution  representing  the  target  (e.g.  the  plane  of  the 

wings  of  an  aircraft  target).  It  is  specified  via,  a 
unit  vector  in  the  craft's  velocity  direction,  and  ep^,  a 
unit  vector  that  is  perpendicular  to  ey  and  points  toward 
the  starboard  side  of  the  craft.  Defining  a  third  unit 
vector,  Ippy  s  epy  x  ey  i  completes  the  definition  of  the 
target  reference  frame. 


aB  plane  -  The  plane  containing  the  center  of  gravity 

of  the  vehicle  and  oriented  such  that  it  is  always 

perpendicular  to  the  line  of  sight  (LOS)  from  the  inertial 

origin  (tracker  location)  to  the  target.  It  is  defined  by 

%  and  1^.  The  vector  e  is  a  unit  vector  in  the  plane 
a  8  a 

that  is  horizontal  and  when  translated  to  the  inertial 

origin  is  displaced  from  the  Zj  axis  by  the  angle  o(t)  in 

the  horizontal  plane.  The  vector  is  a  unit  vector  in  the 

ot  8  plane  that  is  perpendicular  to  i  and  when  translated  to 

01 

the  inertial  origin  is  displaced  from  Yj  by  the  angle  8 (t) 
in  the  plane  formed  by  Yj  and  the  LOS.  Also  of  use  when 
determining  which  ellipsoid  is  closest  (for  purposes  to  be 
seen  in  the  discussion  of  Eq  (3-48))  is  the  range  unit 
vector  ep  which  lies  along  the  LOS. 

These  two  planes  are  Illustrated  in  Figure  6. 


translation  \ 
of  e 


trsuislatlon 


Figure  6.  Target  and  a  8  planes 


These  particular  planes  are  physically  meaningful  since 
projections  of  vectors  from  the  target  plane  onto  the 
plane  can  be  directly  related  to  angular  displacements  of 
alpha  and  beta,  and  thus,  to  pixel  distances  along  the  x  and 
y  FLIR  axes.  Therefore,  by  keeping  track  of  the  vectors 
from  the  target  center  of  gravity  (CG)  to  the  centers  of  the 
ellipsoids,  the  relative  positions  of  the  maximum  intensity 
points  on  the  FLIR  image  plane  can  be  determined. 

To  accomplish  this,  each  of  the  unit  vectors  discussed 
above  must  be  expressed  in  terms  of  the  inertial  unit 
vectors:  i,  j,  and  k.  This,  in  effect,  establishes  the 
direction  cosine  matrices  that  relate  the  vectors,  so 
defined,  to  the  inertial  frame.  Thus, 


so 


and 


so 


e„  s  r-sinai  +  cos  oJc 
a 

el  s  (-sina,  0,  coso)T 
a 

e.  =  -cos  asin  B  i  +  cosBj  -  sin  «  sin  P  k 

P 

el  =  (-cosasinB,  cosB,  -sinosinB)^ 


(3-30a) 


(3-30b) 


where  the  I  gHPerSPriPt  denotes  "coordinatized  in  the  I 
frame."  The  unit  vectors  1^,  epy,  and  Cppy  can  also  be 
written  explicitly  once  the  particular  maneuver  the  craft  is 
to  perform  is  known.  Following  are  typical  trajectories 
considered  in  this  research. 


1:  This  trajectory  was  used  to  evaluate  basic 
filter  performance  versus  a  dynamic  target  image  on  the  FLIR 
image  plane.  It  Involves  straight  line  propagation  (from 
some  initial  inertial  position)  parallel  to  the  Xj  axis 
while  undergoing  a  constant  velocity,  constant  roll-rate 
maneuver.  Specifically, 

^^lo.yio.zio)  =  (5000,  500,  20000)  (m)  (3-31a) 

Vi  =  vio  =  (-1000,  0,  0)T  (m/s)  (3-31b) 

ai  =  a^o  =  (0,  0,  0)T  (m/s)2  (3-31c) 

Thus  a  clockwise  roll  will  result  in  both  the  linear  and 
angular  velocity  unit  vectors  (e^  and  w/  w  )  being  oriented 
in  the  -i  direction.  The  angle  y-|  will  represent  the 
angular  displacement  from  a  horizontal  initial  attitude 

(i.e.  Y-j  is  the  angle  from  J  to  eppy  ,  in  the  Yj-Zi  plane 
when  velocity  is  totally  in  the  +/-  Xj  direction). 

j 
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In  this  case, 


<0 

<  M 

II 

1 

o 

o 

H 

(3-32a) 

I 

®pv  = 

(0,  -sinY-i,  -cosY-|)^ 

(3-32b) 

I 

ppv  = 

(0,  cosY-i  ,  -sinYi)^ 

(3-32C) 

with  Yi  s  Yio  ®  constant  roll-rate  of  u rad/sec. 

Tra;lectorv  £:  In  order  to  evaluate  filter  performance 
against  more  dynamic  maneuvers  this  trajectory  involves  a 
constant  G  pull-up.  For  ease  of  implementation,  the 

maneuver  was  conducted  in  a  plane  parallel  to  the  Xj-Yi 
plane  starting  from  horizontal  flight  in  an  initial  velocity 
direction  equal  to  -i.  An  angle  Y2  represents  the  angular 
displacement  from  the  horizontal  attitude  (l.e.  the  angle 
between  Cppy  and  j  in  the  Xj-Yi  plane).  Prior  to  the 
maneuver,  target  dynamics  are  described  by  Eq  (3-31)«  After 
maneuver  initiation  at  time  t',  the  velocity  equations  are 
described  by 


II 

>< 

> 

-1000  cos[«'(t-t')] 

(3-33a) 

Vy  = 

1000  sinCu'(t-t')] 

(3-33b) 

< 

N 

II 

0. 

(3-33C) 

where  u'  is  dependent  on  the  magnitude  of  the  G  pull-up 
desired.  The  geometry  involved  with  this  maneuver  is  shown 
in  Figure  8 


Figure  8.  Trajectory  2 


where, 


=  (-COSY2,  sinY2f  0)^ 


(3-34a) 


=  (0,  0,  1) 


(3-34b) 


s  (sinY2,  COSY2,  0)^ 


(3-34C) 


Trajectory  3j.  This  trajectory  is  the  general  case  of 
Trajectory  1  where  the  velocity  vector  is  oriented  in  an 
arbitrary  direction.  The  vectors,  Cy  s”**  u  t  again 
defined  to  be  along  the  velocity  direction  with  Ipy  again 
assumed  initially  horizontal.  The  variable  y^  represents 
the  angular  displacement  of  the  craft  (in  the  ®pv-appv 
plane)  from  the  horizontal  orientation  as  the  maneuver 


progresses 


Figure  9.  Trajectory  3 


In  this  case,  the  target  frame  unit  vectors  are  (in  terms  of 
the  inertial  velocity  components): 


T 


and  since  ^py 
«pvo 


I 

®vo 


is 


_  Vy  Vz 

|vi|  |vil  |vil 

assumed  initially  horizontal, 

v  X  J  'vi  X  7 

V  X  31  Rl  X  31 


(3-35) 


(3-36) 


where  the  denominator  term  is  required,  in  general,  to 
normalize  the  vector  resulting  from  the  numerator  cross 
product.  Thus,  using  the  determinant  expansion  method  to 
evaluate  the  cross  product. 


i  j  k 


Vi  X  j  =  Vx  Vy  Vz  =  -Vz  i  +  Vx  k 


(3-37) 


0  1  0 


then, 


I 

®pvo 


221/2  2 
[-Vz/Vx  +  Vz  )  »  0,  Vx/(Vx 


+  Vz  (3-38) 


Similarly , 


®ppvo  =  ®pvo  X  evo 


(^I  X  5)  X  7i  A 

(vj  X  j)  X  VI  Ia) 


(3-39) 


Using  the  determinant  expansion  method  along  with  Eq  (3-37) 


to  determine  A  results  in 


t  5  ic 


A  =  (vi  X  j)  X  VI  s  -Vz  0  vx 


Vx  Vy  Vz 


+  2  2+  + 
-VxVyi  +  (Vx  +  Vz)j  -  VyVzk 


where 


=  [(VxVy)^  +  (Vx  +Vz)  +  (VyVz^^^^^^ 


(3-‘»1) 
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and  finally,  the  vector 


22222  22-* 
eppvo  =  (Vx+Vz)(Vx+Vy  +  Vz)  "^''^[-VxVyi  +  (Vx+Vz)j 


VyVz*^J 

(3-43) 


Therefore,  for  a  constant  roll-rate  about  ey  =  ^vo  » 

-►  -* 

Spy  =  COSY3  epyo  -  sinY3  eppyo  (3-43a) 


®ppv  =  sinY3  epyo  +  C0SY3  eppyo 


(3-43b) 


which  can  then  be  related  to  i,  j,  and  k  via  Eqs  (3-38)  and 
(3-42). 

In  all  three  trajectories  described  above  y^  ,  Y2,  and 
Y3  can  all  be  specified  as  functions  of  time  depending  on 
the  speed  of  the  roll  or  magnitude  of  the  G  pull-up  that  is 
desired.  As  a  result,  a  piecewise  continuous  trajectory  can 
be  formed  with  combinations  of  maneuvers  such  as  these.  Use 
of  the  target  frame  during  such  maneuvers  can  be  illustrated 
by  examining  the  target  geometry  shown  in  Fig  10. 


Figure  10.  Target  Geometry 


The  position  of  the  center  of  each  ellipsoid  of  revolution 
can  be  specified  in  target  coordinates  (relative  to  CG 
position)  as 


Cm  =  «  V  ®v  5  pv  ®pv 
m  m 


(3-MM 


for  m  s  1f2f  and  3*  The  parameters  and  ^pv  represent 


physical  distances  (meters)  of  the  kth  ellipsoid  from  the 
CG  in  the  velocity  direction  and  direction  perpendicular  to 
the  velocity  respectively.  This  vector  can  then  be  projected 
onto  the  oS  plane  to  produce  6  and  (also  in  meters). 

(&  p 

m  m 

These  values  can  then  be  related  to  angular  displacements  of 
a  and  B  as  and  respectively. 

Since  the  angular  displacements  will  be  small  compared 
to  the  target  range  (.p),  the  small  angle  approximation 
yields: 


s  tan(Ao„)  = 

m 

(3-45a) 

ABm  =  tan(ABn)  = 

(3-45b) 

where 

«am  =.rni  *  % 

*  ♦ 

(3-46a) 

. 

«6  m  =  rra  •  ©B 

(3-46b) 

Inserting 

Eqs  (3-44)  and 

(3-46)  into 

Eq  (3- 

45)  and 

converting 

radians  to  pixels 

produces 

Aom  s 

(20x10“^  )“U«v  ^v 

m 

*  ®pv  ^pv 
m 

•  ta] 

(pixels) 

(3-47a) 

^»m  = 

(20x10-^  )-U6v 

m 

+  6  pv  epv 

m 

•  ^B^ 

(pixels) 

(3-47b) 

which  are  to  be  used  to  determine  the  separations  of  the 


V, 


Intensity  peaks  from  the  centroid  location  on  the  FLIR  image 
plane. 

One  characteristic  that  realistic  targets  may  exhibit 
on  the  FLIR  plane  is  the  "disappearance”  of  various  hot¬ 
spots  as  the  target  itself  obscures  sight  of  the 
corresponding  ellipsoids.  Thus,  to  incorporate  this  feature 
into  the  simulation  of  a  dynamic  image,  information  must  be 
generated  on  the  relative  ranges  of  the  target  ellipsoids. 
This  can  be  done  by  forming 


I 


^  ^m  =  r-m 


(3-48) 


for  m  s  1,  2,  and  3.  The  smallest  iirm  indicate  which 
ellipsoid  is  closest  to  the  tracker.  These  values  will  be 
used  when  the  corresponding  one-sigma  images  of  the  Gaussian 
distributions  overlap  on  the  image  plane.  This  is  done  in 
order  to  determine  which  distribution  will  contribute  to  the 
measurement  at  those  points. 
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3.4  fly.erall  Model 


Augmenting  the  truth  model  target  dynamics  and 
atmospheric  distortion  models  in  both  directions  on  the  FLIR 
plane  yields  a  single  eight-state  model  which  can  be 
described  by  the  following  differential  equation. 

=  ExAi^t)  +  BxiiT^t)  +  fixHx^t)  (3-49) 


iX^t^  =  (3-50) 

where 


and 


Ht  = 


1  0  1  1  0  0  0  0 
0  1  0  0  0  1  1  0 


where  ^ 


Qa  0 

ECaT(t)iix(t+ t)  ]  s 

0  Qa 


Thus,  the  equivalent  discrete-time  model  of  the  overall 
system  is  described  by  the  propagation  of  Eq  (3-^9)  from 
time  t^  to  time  t^+i  yielding 

^T^^i+I^  ■  ^i+l » ti)xx^ti)  +  fidUd^^i^  +  fidJid^ti)  (3-51) 


where 


ixCtiti)  =  Exll^^t^i^ 


Ix^tijtj)  =  I 


Thus, 
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1 
0 
0 
0 

,ti)=  0 

0 
0 
0 


0  0  0  0  0  0  0 

1  0  0  0  0  0  0 

0  e-AAt  0  0  0  0  0 

0  0  e-BAt  Ate-BAt  0  0  0 


0  0 
0  0 
0  0 
0  0 


0  0  0  0 
0  0  e”AAt  0  0 

0  0  0  e“BAt4te“BAt 

0  0  0  0 


and  using  the  approximations  to  the  azimuth  and  elevation 
velocities  given  in  Eq  (3-28) 


U(l(ti)  =  Citi)  B(ti)  a(ti)  8  (ti)] 


c  _  T 

such  that  VfiTd  V^Td  =  ^^Td 
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El]id(ti)iid(tj)]  = 
and  where 

,T)dT  (3-52) 

The  details  for  determining  the  elements  of  Q^d  via  exact 
integration  are  shown  in  Appendix  A. 

3.5  £LI£  MfiaaucsmfliLta 

The  FLIR  measurements  are  "outputs"  representing  the 

average  intensity  of  target  radiation  incident  on  an  array 

of  detector  surfaces.  These  values  are  corrupted  by 

background  and  device  noises.  In  spite  of  the  noises 

(j!I  present,  the  EfCF  processes  a  history  of  FLIR  measurement 

data  frames  in  order  to  determine  the  underlying  shape  of 

» 

the  target  image;  and  subsequently,  to  predict  the  desired 
pointing  direction  of  the  high  energy  laser.  However,  the 
shape  Itself  may  display  different  characteristics  depending 
on  several  factors.  Specifically,  the  amount  of  target 
detail  that  can  be  distinguished  by  the  FLIR  is  dependent 
upon  both  the  atmospheric  distance  that  the  target  radiation 
must  propagate  through  to  reach  the  sensor,  as  well  as  the 
diffraction  effects  inherent  in  the  optical  system.  Since 
these  factors  tend  to  make  detail  less  distinguishable,  FLIR 
images  of  distant  targets  can  be  modelled  as  bivariate 
Gaussian  intensity  distributions  with  circular  (Ref:  12) 


flTd  = 


T  T 
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and/or  elliptical  (Ref:  5)  equal-intensity  contours. 
However,  such  models  are  inadequate  in  many  cases  when 
targets  are  larger  or  much  closer  since  the  image  begins  to 
take  on  more  detail.  Such  a  "multiple  hot-spot"  target 
image  can  be  better  modelled  as  the  sum  of  contributions 
from  M  such  bivariate  Gaussian  intensity  distributions. 
Thus,  the  intensity  output  of  any  one  pixel  (picture 
element),  within  the  8x8  pixel  array  that  constitutes  one 
data  frame,  can  be  described  as  follows: 

r 

s  (1/Ap)  J  Im(*»y»Xpm^ti^  »ypm^ti)^‘**^y 

kl— th  m=i 
pixel 


+  Vki(ti)  (3-53) 


where 


Im(’)  *  intensity  of  the  m-th  component  of 

the  target  radiation  on  the  FLIP  image 
plane  as  a  function  of  the  position  in 
the  frame  and  the  position  of  the  peak 
of  the  mk-th  hot-spot,  out  of  a  total  of 
N  hot-spots 

^kl^ti)  =  intensity  output  of  the  kl-th  pixel  at 
time  ti> 

Ap  =  area  of  a  single  pixel. 


(x,y)  s  the  coordinates  of  an  arbitrary  point 
within  the  kl-th  pixel. 


(Xom^ti) ,yDm(ti))  =  coordinates  of  the  intensity  peak 

of  the  m-th  image  hot-spot. 

Vki(ti)  =  noise  added  to  the  kl-th  pixel 
representing  FLIR  and  spatially 
correlated  background  noises. 


59 


When  the  general  form  of  a  target  can  be  well  represented  by 
M  ellipsoids  of  revolution  in  inertial  space,  then  the 
projection  of  the  target's  image  onto  the  FLIR  plane  can  be 
described,  in  general,  as  M  or  fewer  elliptically-shaped 
contours.  In  such  a  case,  the  contribution  to  the  (x,y) 
point  in  the  kl-th  pixel  from  the  bivariate  Gaussian 
representing  the  m-th  hot-spot  can  be  described  as 


!„{•}  =  (Imaxn,)exp{-.5[(x-xpn,)(y-ypn,)] 


C(x“Xpm)(y-ypm^^^^  (3-54) 


where 


Imax^i  s  the  maximum  intensity  of  the  m-th  hot¬ 
spot. 


^^omiynm)  gives  the  location  of  the  peak 
or  the*^m-th  hot  spot. 


£in  =  the  matrix  correspondint  to  the  m-th 
hot-spot  whose  eigenvalues  are 
apv^.  1'he  latter  two  parameters 
represent  the  dispersions  of  the  m-th 
bivariate  Gaussian  elliptical  contour 
Intensity  distribution  in  the  target 
velocity  direction  and  the  direction 
perpendicular  to  velocity  on  the  FLIR 
image  plane. 


3.6  Target  Ima&fi 


It  is  assumed  in  this  research  that  side-slip  angle  and 
target  angle  of  attack  are  essentially  zero.  Thus  the  semi- 


•V 


major  axes  of  the  target  ellipsoids  will  be  aligned  parallel 
to  the  inertial  velocity  vector.  This  Implies  that  the 
semi-major  axes  of  the  elliptical  equal-intensity  contours 
on  the  FLIR  plane  will  be  aligned  parallel  to  the  FLIR 
velocity  vector  as  well.  A  typical  FLIR  image  of  a  three 
hot-spot  target  might  appear  as  shown  in  Fig  11. 


« 


Fig  11.  FLIR  Image  Geometry 
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where 


e 


’pi 


-t-  B  e 


FLIR  plane  velocity  vector 
(projection  of  viloS  onto  the 
FLIR  plane)  ^ 


•¥  *  * 

Vpi  s  [  ci2  +  b2]1/2  =  magnitude  of  the  FLIR  plane 

velocity  vector  (pixels/sec) 

s  image  dispersion  of  the  m-th  distribution  in  the 
planar  velocity  direction. 

=  image  dispersion  of  the  m-th  distribution  in  the 
direction  perpendicular  to  the  planar  velocity. 

Thus, 


cos  e 


azimuth  velocity 
[v  J.L0S) 


and 

\ 

sin  e 


B  elevation  velocity 

|^pi|  pIEosj” 


(3-55) 


Although  the  target  dimensions  are  constant,  its  image's 

dimensions  vary  depending  on  range  and  orientation. 

However,  the  image  dimension  can  be  specified  in  term  of 

some  initial  size  (o^^  ^  ®pvo  some  Initial  range  (Cg), 

m  m 

and  the  current  range  and  velocity.  The  initial  size 

parameters,  oyo  and  cpyo  »  assumed  specified  with  the 

m  m 

target  lying  in  the  plane  perpendicular  to  the  LOS  since 
this  orientation  will  then  produce  the  maximum  sized  image 
for  that  particular  range. 

Since  the  target  is  modelled  as  Ms3  ellipsoids  of 
revolution,  the  semi-minor  axes  of  the  target  image,  apy 

m 

for  m  s  1,  2,  and  3,  will  only  vary  with  a  dependence  on 
target  range.  Specifically, 

®pv  “  ® pvo  Po^P  (3-57) 
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Figure  12.  Plane  Perpendicular  to  the  LOS 


In  contrast,  the  semi-major  axes  of  the  target  image, 

expressed  by  Oy  for  m  s  1,  2,  and  3,  will  also  depend  on 

in 

the  orientation  of  the  target  with  respect  to  the  plane 
perpendicular  to  the  LOS.  As  indicated  in  Fig  12  and  Eq  (3- 
58),  this  dependence  can  be  expressed  in  terms  of  c ,  the 
angle  between  the  inertial  velocity  vector  and  the  plane 
that  is  perpendicular  to  the  line  of  sight. 


(3-58) 


V  =  (<*  t  *Dvo  CO®  ®VO  “®PVO  ^  ^ 

m  m  m  m 


=  ffpv  [1  +  (  VJLLOS  /  '^I  )(ARni-1)] 

m 


where 


^^m  =  °vo  /®Dvo  =  Maximum  Aspect  Ratio  of  the  m-th 
mm  hot-spot  of  the  target  image 

The  validity  of  Eq  (3-58)  can  be  demonstrated  by  noting  that 
when  the  target  is  flying  in  the  plane  perpendicular  to  the 
LOS  (  c  =  QO),  the  maximum  aspect  ratio  is  presented  to  the 
tracker  with  the  image  semi-major  axes  dependent  on  range. 
Specifically, 

ay  =  ®vd  ^or  c  s  0®  (3-59) 

m  m 

Also,  when  the  target  is  flying  perpendicular  to  this  plane 
(c  =  90®),  the  minimum  aspect  ratio  (AR  =  1)  is  presented  to 
the  tracker,  creating  circular  equal-intensity  contours  on 
the  image  plane.  That  is, 

®v  -  ®  pvo  **o/p  -  ®  pv  Tor  c  s  90®  (3—60) 

mm  m 

In  reference  to  Figure  11,  the  transformation  to  transform 
vectors  on  the  FLIR  image  plane  that  are  in  a  frame  aligned 

with  VpL  (coordinates  x',y')  to  the  o6  frame 
(coordinates  x,  y)  is  the  following. 


fill 
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A  (3-61) 


Transformation  of  a  2x2  dispersion  matrix,  £',  from  the 
(x',y')  frame  to  the  (x,y)  frame  is  accomplished  by 

£  =  A£’AT  (3-62) 


To  compute  measurement  information,  it  is  desired  to 
transform  diagonal  2x2  matrices  whose  eigenvalues  are  the 
Inverse  variances  (dispersions)  of  the  intensity 
distributions  as  expressed  in  the  (x',y')  FLIR  frame.  In 
general,  the  result  of  the  transformation  will  no  longer  be 
diagonal  in  the  (x,y)  FLIR  frame.  For  the  direction  cosine 
matrices  relating  the  frames,  it  is  easily  verified  that 

AT  =  A-1  (3-63) 

•  - 

Therefore,  £»-1  will  transform  in  the  same  manner  as  £'. 
That  is, 

£“■•  =  A(£')-‘'aT  (3-64) 

To  check  this,  ££~1  can  be  shown  to  be  equal  to  I  using  Eqs 
(3-62),  (3-63),  and  (3-64). 

££-l  =  ((A£'AT)(A(£')-UT) 

=  A£'I(£')-UT 

s  AIaT 

=  I  (3-65) 
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Iiai££ 

In  his  research,  Mercier  (Ref:  12)  modelled 
dicturbances  in  measurement  information  due  to  the  FLIR  and 
background  as  spatially  uncorrelated,  zero-mean,  white, 
Gaussian  noises.  Subsequently,  observations  by  AFWL 
personnel  and  an  analysis  of  actual  data  (Ref:  5)  have 
indicated  the  existence  of  significant  spatial  correlations 
of  the  background  within  the  FLIR's  field  of  view  for 
"distances”  of  up  to  40  microradians  (urad);  or 
equivalently,  two  pixels  on  the  FLIR  image  plane. 

Modelling  of  spatial  noise  correlations  in  the  8x8  FLIR 


field  of  view  using  the  measurement  equation. 


i(ti)  =  hCi,(ti),ti]  +  y:(ti) 


(3-66) 


is  accomplished  by  allowing  non-zero  cross-correlations 

between  the  64  components  of  the  noise  vector,  it(ti)* 
Assuming  the  variances  of  the  64  background  noises  are  of 
equal  strength,  Eq  (3-66)  implies  the  existence  of  a  general 
noise  covariance  matrix  of  the  form: 


E[3t(ti)ltT(tj)]  =  fisij 


Such  that  in  this  case. 


(3-67) 


1 

1 

^1,2 

n,3 

•••  >"1,64 

>"2,1 

1 

’  **1,3 

...  r2,64 

„  2  2 

^  =  ‘^bfi  =  ^^b 

n 

**3,1 

• 

•"3,2 

• 

1 

•••  >"3,64  (3-68) 

«  • 

■ 

• 

^64,1 

• 

• 

>*64,2 

^64,3 

•  • 

• 

...  1 

where 


=  64  element  spatially  correlated  noise  vector 


=  64x64  element  noise  covariance  matrix 

=  64x64  element  noise  correlation  coefficient 
matrix 

s  correlation  coefficient  representing  the 

correlation  between  the  scalar  noise  components; 

^kil^=l>64  and  vi,  1=1,64  at  time  tj. 


®b  =  variance  of  any  of  the  64  background  noises 

More  specifically,  each  component  of  the  64  element  noise 
vector;  V|^(tj^)  k=1,64;  corresponds  to  the  noise  corrupting 
the  k-th  pixel  within  the  8x8  FLIR  array  at  time  ti*  The 
location  of  the  k-th  pixel  in  the  FOV  is  defined  using  the 
following  pixel  numbering  scheme. 
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Figure  13.  Pixel  Numbering  Scheme 


Therfore  modelling  non-zero  spatial  correlations  between 
the  k-th  pixel  and  all  other  pixels  within  a  two  pixel 
distance  results  in  first  and  second  nearest  neighbor 
correlations.  The  non-zero  terms  in  the  noise  covariance 
matrix  due  to  such  correlations  with  the  k-th  pixel  of 
Figure  13  are  indicated  in  Figure  14.  The  term  in  the 
upper-left  portion  of  each  pixel  displayed  in  Figure  14 
corresponds  to  the  pixel  location  in  the  numbering  scheme 
shown  in  Figure  13.  Each  subscripted  term  in  Figure  14 
represents  the  correlation  coefficient  relating  the  spatial 
correlation  between  that  particular  pixel  and  the  k-th 
pixel.  For  zero-mean  random  variables  the  statistical 
definition  of  the  correlation  coefficient  is  (Ref;  7t  P  91): 
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where  is  the  distance  in  pixels  from  the  center  of  the 

k-th  pixel  to  the  center  of  the  1-th  pixel.  From  Eq  (3-70) 
it  is  reasonable  that  correlations  beyond  the  second  nearest 
neighbor  be  ignored  since,  for  pixels  beyond  these  second 
nearest  neighbors,  the  corresponding  correlation  coefficient 
is  over  an  order  of  magnitude  smaller  than  rjc^k  =  From 

Eqs  (3-69)  and  (3-70)  it  can  be  seen  that  =  ri^k  and 

that,  for  the  first  and  second  nearest  neighbors,  the  pixel 
distances  and  resulting  correlation  coefficients  are  as 
indicated  in  Table  3.1.  Upon  examining  the  entries  in 
Table  3>1  and  their  corresponding  locations  as  indicated  by 
Figure  14;  it  can  be  seen  that  the  first  coefficient  listed 
in  Table  3.1  would  appear  once,  the  second,  third,  fourth, 
and  sixth  would  appear  four  times  while  the  fifth  entry 
would  appear  eight  times.  All  other  correlations  with  the 
k-th  pixel  would  be  zero.  Thus  only  six  different 
correlation  coefficients  are  needed  to  model  spatial 
correlations  using  the  second  nearest  neighbor  restriction. 
The  appropriate  values  of  the  noise  covariance  matrix  are 
determined  by  multiplying  the  components  of  the  correlation 
coefficient  matrix  by  the  desired  noise  variance  as 
indicated  in  Eq  (3-68).  Realizations  of  the  noise  vector, 

can  be  simulated  by  premultiplying  ^'(tj^),  a  vector 
of  unit  variance,  spatially  uncorrelated,  white,  Gaussian 

noise,  by  VS”  the  Cholesky  square  root  of  the  covar¬ 
iance  matrix. 


Table  3.1.  Non-zero  Correlation  Coefficients 


a  64  component  vector  of  zero-mean,  unit 
variance,  white,  independent  components 
(i.e.  s  x«ij) 


V  R  r  Lower  triangular  Cholesky  square  root  of  the 
covariance  matrix. 

The  following  Illustrates  that  the  covariance  matrix  of  the 
noise  generated  from  this  method  Is  equivalent  to  that 
defined  In  Eq  (3-67). 

o  c  ^ 

EC^(ti)y(tj)]  =  E[yisL'(ti)it«(tj)T  y/T  ] 

=  v/T  E[jt'(ti)£'(tj)”]  /T 
c  c 

-  X  s  Ij 

=  R  «  ij  (3-73) 

A  description  of  how  the  realizations  of  the  vector,  y.’(t), 
are  obtained  through  the  use  of  pseudorandom  codes  can  be 
found  In  Appendix  C. 

3.9  Summary 

This  chapter  presented  the  mathematical  models  used  to 
represent  the  real  world.  These  models  described  the 
effects  of  target  dynamics,  atmospheric  Jitter,  and 
spatially  correlated  background  noises  on  the  location  of 
the  target's  intensity  distribution  on  the  FLIR  Image  plane. 
Once  defined,  the  atmospheric  and  dynamics  models  were 
combined  In  a  single  state  space  model  for  ease  In  propaga¬ 
ting  the  states  through  time.  Detailed  consideration  was 
also  given  to  creating  the  measurement  data  required  In  the 


computer  simulation.  Efforts  were  made 
spots  of  multiple  hot-spot  Images  in  a 
target  maneuvers  progress. 


C 


to  locate  the  hot- 
dynamic  manner  as 
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IV.  Extended  Kalman  Filters 


4.1  Introduction 

In  principle,  use  of  an  extended  Kalman  filter  In  this 
application  assumes  that  the  nonlinear  intensity  function 
within  Eq  (3*53)  can  be  linearized  about  iCt^)  by  using  a 
first  order  Taylor  series  approximation,  at  least  for  filter 
gain  calculation.  Although  the  validity  of  this  assumption 
is  dependent  upon  the  degree  of  nonlinearity  Involved  in  the 
state  dynamics,  the  high  measurement  rate  used  in  this 
research  Indicates,  comparatively,  that  such  an 
approximation  is  not  inappropriate.  This  chapter  presents 
the  development  of  the  two  different  dynamics  models  as  well 
as  the  atmospheric  Jitter  model  used  by  the  extended  Kalman 
filters  in  this  research.  Both  dynamics  models  estimate 
position,  velocity,  and  acceleration  of  the  target  image  on 
the  FLIR  plane.  However,  the  first  model  discussed 
represents  the  target  acceleration  as  a  first  order  Gauss- 
Narkov  process.  In  contrast,  the  second  dynamics  model 
portrays  the  acceleration  as  that  of  a  constant  speed, 
constant  turn-rate  process.  Since  the  dynamics  of  the 
filters  based  on  these  models  are  different,  they  employ 
different  state  propagation  equations;  however,  both  use  the 
same  set  of  measurement  update  equations  as  presented  in  the 
final  portion  of  this  chapter. 
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4 <2  £l£^  flrdsr  Gau33-Markov  Acceleration  Hfidfil 


In  thl3  aection  the  target  acceleration  and  atmoapherlc 
Jitter  position  states  are  modelled  as  stationary,  first 
order,  Gauss-Markov  (GM)  processes.  Representations  of  each 
such  process  can  be  generated  as  the  output  of  a  first  order 
lag  driven  by  zero-mean  white  Gaussian  noise.  It  Is 
believed  that  a  first  order  model  for  filter  estimation  of 
atmospheric  Jitter  Is  sufficient;  In  contrast  to  the  third 
order  atmospheric  truth  model.  Since  the  double  pole  In  the 
truth  model  Is  sufficiently  Isolated  In  the  left-half 
s-plane,  neglecting  It  does  not  seriously  affect  the  lower 
frequency  characteristics  of  the  Jitter.  Thus  the  state 


vector  can  be  written  as 

=  £'XD»yD»VxfVy,ax,ay,XA,yA3^  ('♦-D 

or  In  terms  of  two-dlmens?  '^nal  vectors 

ip  =  '  (4-2a) 

i  =  a  (4-2b) 

i  =  (-1/‘^Dp)a  +  Hj)  (4-2c) 

=  (-1/'^AF)JIA  +  HA  ('*-2d) 

and  finally, 

*  EpapCt)  +  fipHpCt)  (4-3) 
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where 


=  Cw^pi  (t)wpp2(t)wj^pi  (t)  wy^pgCt)]  (4-4) 

such  that 

ip(t)  =  filter  state  vector 
£p(t)  =  filter  plant  matrix 

Up(t}  s  zero-mean  white  Gaussian  noise  vector 
Qp  s  noise  input  matrix 
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T  j)p  =  correlation  time  assumed  for  target  acceleration 


AF  "  correlation  time  assumed  for  atmospheric  jitter 
The  statistics  of  the  noise  processes  are 


T 

E[MF(t)jiF(t+T)]  =  Qp 


where 


flF  = 


^®df/^df  0 


0  2o uf/^df 


2oaF/^AF  ° 


2aAF/^  AF 


is  the  noise  covariance  kernel  descriptor  that  yields  the 
desired  RMS  noise  values  in  which 


° DF  s  the  assumed  target  acceleration  process  variance 
2 

°AF  -  assumed  atmospheric  jitter  process  variance. 


Of.  Jthfi 


Filter  Model 


Since  the  state  equations  of  the  GM  model  are  linear, 
they  can  be  propagated  in  time  using  the  conventional  Kalman 
filter  propagation  equations.  For  propagation  from  one 
sample  time  tj^  to  the  next  tj^l  these  equations  are 


xCfi+i)  i  lF(ti+1»ti)£(ti)  (^-6] 

and 

£(ti^^)  s  lF(ti+1  »ti)£(ti)AF(ti+1  *ti) 

+  flFD(ti+1»ti)  (4-7) 

where 


•*F(ti+i,ti)  =  the  filter  state  transition  matrix 

£(tt)  =  the  conditional  state  covariance  matrix 
after  the  measurement  update  at  time  tj^ 

£(ti^l)  =  the  conditional  state  covariance  matrix 
after  propagation  from  time  t^  to  ti+i 


Also, 

^i+1 

/T  T 

If^^i+i  ,T)fiFQFfiFiF(ti+1 ,  OdT 
ti 

(4-8) 


which  represents  the  growth  in  the  uncertainty  of  the  state 
estimate  due  to  model  uncertainty  and  the  addition  of  noise 


between  measurements.  Since  the  filter  plant  matrix,  £p  is 
constant,  the  state  transition  matirx,  which  must  satisfy 

lp(t,ti)  =  EFlF(t,ti)  (4-9) 

and 


^F(ti.ti)  =  I  (4-10) 

will  be  a  function  only  of  the  sampling  period 
( At  =  ^i+1-ti)  as  opposed  to  being  a  function  of 
ti+1  and  ti  separately. 


Therefore, 


^F(ti4.i,ti)  =  iF(At)  = 


0  0  At 
0  1  0 
0  0  1 
0  0  0 
0  0  0 
0  0  0 
0  0  0 
0  0  0 


0  J1  0 
At  0  J1 
0  J2  0 
1  0  J2 

0  J3  0 
0  0  J3 

0  0  0 
0  0  0 


(4-11) 


where 


J1 

J2 

J3 
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Similarly,  flpD  also  a  function  only  on  the  sampling 
period.  Evaluating  the  integral  in  Eq  (4-8)  yields  a 
constant  matrix  of  the  form 


A1 

0 

A2 

0 

A3 

0 

0 

0 

0 

A4 

0 

A5 

0 

A6 

0 

0 

A2 

0 

A7 

0 

A8 

0 

0 

0 

flFD  = 

0 

A5 

0 

A9 

0 

A10 

0 

0 

A3 

0 

A8 

0 

All 

0 

0 

0 

0 

A6 

0 

A10 

0 

A12 

0 

0 

0 

0 

0 

0 

0 

0 

A13 

0 

0 

0 

0 

0 

0 

0 

0 

A14 

Results  of  the  exact  integration  of  non-zero  terms  of 
Eq.  (4-8)  can  be  found  in  subroutine  FILTER  in  the  Fortran 
source  code  in  Appendix  G. 

4.4  lurtlr.Ra^  Acceleration  Modfil 

In  contrast  to  the  first  order  CM  acceleration  model, 
the  constant  turn-rate  (CTR)  acceleration  model  considers 
the  target  dynamics,  after  being  projected  onto  the  FLIR 
image  plane,  to  be  well  represented  as  constant  speed, 
constant  turn-rate  manuevers.  Although  this  model  more 
accurately  portrays  typical  airborne  target  dynamics  than 
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the  GM  model  (Ref:  3y  11*  19}f  it  is  implemented  with  the 
cost  of  additional  filter  computation  due  to  the 
nonlinearity  of  the  filter's  description  of  jerk  level 
motion  (the  time  derivative  of  acceleration). 

Specifically,  the  CTR  acceleration  dynamics  model  is 
(Refs:  3,  11,  19) 


a  =  -<o  2 


i  +  hdf 


(4-13 


which  implies  a  state  differential  equation 


iF(t)  =  * 


♦  WDFl(t) 


-u^v  + 


WDF2' 


(4-14) 


-(IAaf)xa  +  WAFI^t) 
-(1/taf)xa  +  waF2^^^ 


such  that, 


XF(t)  =  CxD,yD,Vx,Vy,ax,ay,XA,yA3 


(4-15) 


which  are  the  same  eight  states  as  defined  by  Eq  (4-1);  and 


a 


a 


where 


£[jlp(t),t]  =  a  nonlinear  function  of  the  filter  states 


u  =  the  magnitude  of  the  target's  turn-rate  on 
the  FLIR  image  plane 

=  zero  mean,  white,  Gaussian  driving  noise 
vector 

£ip  s  noise  input  matrix 

■^AF  =  correlation  time  assumed  for  the  atmospheric 
jitter 


The  statistics  of  the  noise  vector  are 


E[iip(t)iip(t+T)]  =  fip«(T) 

^fHp(t)HF(t+'')  ]  = 
where 

0 

0 


Qp  = 


0 

0 


0 

0 


^AF 

0 


(4-17a) 

(4-17b) 


(4-17) 


is  the  covariance  kernel  descriptor  that  yields  the  desired 
RMS  noise  values  when 


2 

T df  -  bhe  assumed  target  acceleration  white  process 
power  spectral  density  value 


T  aF  =  assumed  atmospheric  Jitter  Markov-1  process 
variance. 


4.5  Fcapflgatlon  a!  JJia  Constant  Turn-Rate  Model 

In  terms  of  the  state  differential  equation,  Eq  (4-2), 
and  discrete  time  Instants,  the  state  estimate  propagation 
can  be  written  as 

^1+1 

+  /  f[i(t/ti),t]dt  (4-18) 

ti 

or  equivalently 

^1+1 

=  i(ti)  +  f  i(t/ti),dt  (4-1 

ti 

Using  a  first  order  Euler  integration  approximation  to  Eq 
(4-19)  over  the  interval  At  s  t^^i  -  tj  yields 

i(ti^l)  s  i(t^)  ♦  i(tj^)At 

=  i(ti)  +  f[i(ti),ti]At  (4-20) 

which  is  based  on  the  most  recent  state  estimate,  £(ti)* 
Equation  (4-20)  neglects  second  and  higher  order  terms  by 
assuming  that  the  state's  time  derivative  is  constant  during 
each  interval.  This  approximation  is  valid  when  t  is 
sufficiently  small  when  compared  to  the  natural  transient 
times  of  the  physical  system. 

Similarly,  the  covariance  propagation  must  also  be 


written  in  terms  of  the  most  recent  state  estimates  since 


(4-21) 


3£Cjt(t/t) , t] 

E(ti)  =  - 

a 

X=Jt(t+) 

is  no  longer  constant  as  it  was  in  the  GM  filter.  In  other 
words,  (Eq  4-21)  assumes  that  the  time  varying  JE(t)  can  be 

approximated  by  the  piecewise  constant  function  ECt^)*  This 
quasi-static  assumption  is  valid,  again,  when  At  is  small 
compared  to  the  rate  that  £(t)  varies. 

Therefore,  standard  covariance  propagation  equations 
can  be  used  with  the  restriction  that 

lF(ti+i,ti)  =  exp(E(ti)At)  (4-22) 

and  thus 

^i+1 

f  T  T 

^FD^^i+1»^i^  ~  J  (4-23) 

ti 

be  re-calculated  each  sample  period.  However,  there  is 
significant  computational  loading  on  the  filter  due  to 
Eqs  (4-22)  and  (4-23).  To  avoid  much  of  the  real  time 
computation,  the  upper-left  6x6  portion  of  the  state 
transition  matrix  in  Eq  (4-22)  is  truncated  to  first  order 
terms,  as  in  Eq  (4-24). 

4.F(ti+i,ti)  =  I  +  E(ti)At  (4-24) 

This  portion  is  Instrumental  in  the  covariance  propagation 
of  the  states  related  to  the  target  dynamics.  The  remaining 
portion,  which  is  associated  with  the  two  atmospheric 
states,  is  time  invariant  and  can  be  determined  in  its  exact 
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closed  form.  The  derivation  of  E(ti)  and  Ip^^i+lt^i^ 
be  found  in  Appendix  B.  For  the  same  reasons,  the  Qpj) 
matrix  was  also  simplified.  One  consideration  is  simply  to 
use  the  constant  flpQ  matrix  calculated  for  the  Gauss-Markov 
model.  Such  an  implementation  is  reasonable  since  realistic 
correlation  coefficients  are  maintained  in  the  off-diagonal 
terms.  Another  possibility  is  to  approximate  Eq  (4-23)  by 


Afd  =  fipfiF^iF 


(4-25) 


The  latter  la  probably  more  appropriate  for  use  in  the  CTR 
model  since  this  model  is  a  truer  representation  of  the 
actual  target  dynamics;  and  consequently,  introduces  much 
smaller  uncertainties  into  the  state  propagation.  The  form 
of  the  flpp  matrix  given  by  Eq  (4-25)  is  such  that  all 
elements  are  zero  except  for  the  four  lower-right  diagonal 
elements. 


4.6  Mfiaaurenfint  Equationa 


It  is  because  of  the  nonlinear  characteristics  of  the 
FLIR  measurements  that  a  simple  linear  Kalman  filter  cannot 
be  used  alone  in  the  HEL  pointing  and  tracking  problem. 
Specifically,  this  is  so  because  the  Intensity  function 
acquired  from  FLIR  measurements  is  a  nonlinear  function  of 
the  system  states  (for  both  the  Gauss-Markov  and  Constant 
Turn-Rate  models).  In  general,  the  measurement  equation  has 
the  form 
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Zkl(ti)  =  hkiCxCti)  ,ti]  +  vici(ti) 


(4-26) 


which  is  equivalent  to  Eq  (3-53)  expressed  in  terms  of  the 
kl-th  pixel.  After  propagating  the  state  estimate  from  time 
ti_i  to  til  it  is  desired  that  the  filter  use  the  estimate 
along  with  the  64  pieces  of  new  measurement  information 
represented  in  Eq  (4-26)  to  determine  an  updated  estimate  of 
the  target's  centroid  location  on  the  image  plane.  To 
process  this  informatin,  an  extended  Kalman  filter  is 
thought  to  be  best  suited  for  the  task  since  it  accounts  for 
nonlinearities  in  the  measurement  equation  (to  a  degree,  and 
this  is  superior  to  a  linearized  Kalman  filter)  and  is  not 
as  burdensome  as  higher  order  nonlinear  filters 
(Ref:  8,  Ch  11,12).  In  effect,  the  extended  Kalman  filter 
relinearizes  the  measurement  equation  every  sample  period 
about  the  most  recent  estimate  -of  the  system's  state,  £(ti). 

Since  computation  time  is  critical  in  this  application, 
the  inverse  covariance  form  of  the  measurement  update  equa¬ 
tions  is  beneficial  since  it  does  not  require  the  on-line 
inversion  of  a  64x64  matrix  (since  s  £-]lT(|i£-iiT+^)-1 )  at 
every  update.  In  contrast,  when  the  update  equations  are 
formulated  in  this  manner  only  two  8x8  inversions  are 
required  on-line.  Thus,  the  equations  can  be  written  as: 


£-‘l(ti)  =  £-‘'(ti)  ♦  flT(t^)£-1(ti)il(ti) 


=  C£-l(tt)]-l 


(4-27) 


(4-28) 


K(ti)  r  £(tt)flT(ti)a-‘l(ti)  (4-29) 


i(tt)  =  £(tp  K(ti)ti(ti)  -  il(i(tl),ti)]  (4-30) 

where 

)l[£(tp,tj^]  =  a  nonlinear  Intensity  function  written  in 
terms  of  the  most  recent  state  estimate, 
i(tiX 

3ll[jt(ti^)  ,tt] 

il(ti)  =  - 

ax 

jt(ti)  =  jt(ti) 

s  the  linearized  function  of  the  intensity 
measurements  evaluated  at  the  most 
recent  state  estimate 

£(tp  s  the  conditional  covariance  matrix  after 
propagation  to  time  ti  and  before  the 
measurement  update  at  that  time 

£(t^)  -  the  conditional  covariance  matrix  after 
the  measurement  update  at  time  tj^ 

K(ti)  -  Kalman  filter  gain 

£(tj^)  s  the  actual  realization  of  the  measurement 
vector  at  time  t^* 

The  method  used  to  derive  the  nonlinear  and  linearized 
intensity  functions  involves  the  use  of  the  FFT,  phase 
shifting  and  smoothing  techniques  as  presented  in  Chapter 


4.7  tonamic  Privlng  Mfliaa 


The  dynamic  driving  noise  matrix,  Qfd»  used  to 
model  the  statistics  expected  of  the  target's  dynamics. 
Since  the  targets  being  tracked  may  exhibit  a  variety  of 
dynamic  characteristics,  the  "optimal"  dynamic  driving  noise 
in  the  Kalman  filter  model  will  not  be  constant.  If 
variances  are  chosen  large  enough,  use  of  a  constant  dynamic 
driving  noise  matrix  (QpD^  enable  the  filter  to  maintain 
track  on  maneuvering  targets;  however,  less  than  optimal 
performance  is  obtained  when  the  target  exhibits  a  benign 
trajectory. 

In  this  research,  a  time  varying  dynamic  driving  noise 
is  appropriate  in  two  instances:  when  the  filter  is  in  an 
acquisition  mode,  and  when  maximum  tracking  efficiency  is 
desired  in  regard  to  the  relationship  between  actual 
tracking  errors  and  the  filter's  estimate  of  its  own  errors. 
During  acquisition,  the  filter  is  handed  information  about 
the  target's  position  and  velocity  from  some  device  such  as 
radar.  To  deal  with  inaccuracies  in  this  information,  the 
filter's  initial  state  covariance  matrix,  2^,  and  driving 
nlse,  QfD'  raised  to  values  above  what  they  would 

normally  be  during  steady  state  operation.  The  matrix 

is  then  reduced  linearly  until  a  reasonable  level  is  reached 
or  the  adaptive  mode  is  initiated.  Meanwhile,  the  state 
covariance  matrix  is  allowed  to  propagate  and  update  as 
usual. 


Methods  available  for  Qpp  adaptation  include  maximum 
likelihood  techniques,  Bayesian  and  multiple  model 
algorithms,  as  well  as  correlation  and  covariance  matching 
techniques  (Ref:  8,  Ch  10).  In  this  research  an  approxima¬ 
tion  to  the  maximum  likelihood  technique  is  investigated 
rather  than  a  full  scale  likelihood  estimator  since  the 
latter  involves  significant  computational  loading.  Also,  a 
crude  simulation  of  multiple  modelling  can  be  implemented  by 
giving  the  filter  knowledge  of  the  time  a  maneuver  is 
initiated  and  artificially  increasing  an  otherwise  time- 
invariant  Qpu  matrix. 

Specifically,  the  Qpj)  estimator  can  be  derived  as 
follows.  Given  the  covariance  propagation  equation, 

T 

£(ti)  s  ip(ti, ti_i )£(tiii )tF^ ti, ti_i )  +  QFD(ti»i)  (4-31) 
and, 

£(ti)  =  £(ti)  -  K(tilii(ti)£(ti)  (4-32 

solving  for  QfD  while  keeping  the  latter  term  in  Eq  (4-32) 
intact  yields: 

flpD  (ti.i)  =  K(ti)fl(ti)£(ti)  +  £(tt  ) 

-  lFCti,ti.i)£(tt_l)iF(ti,ti-i )  (4-33) 

All  of  the  quantities  on  the  right  hand  side  of  the  above 


equation  are  available  except  the  first  term.  This  term 
will  be  estimated  from  the  filter  residuals.  Rewriting  the 
measurement  update  equation,  the  state  update  can  be 
expressed  as 

i(ti+)  -  xCti")  =  Ax(ti)  =  K(ti)n(ti)  (4-34) 

The  sequence,  Ax(ti)f  is  a  white  sequence  with  covariance 

^  ^  i  )  H(  t  i  )  £(  t  i  )  and  is  independent  of  Jt(ti) 
(Ref:  8,  Ch  10). 

E[Ax(tj^)  Ax(tj^)T]  =  K(ti)Ii(ti)£(ti“)  (4-35) 

Then,  assuming  the  filter  is  essentially  in  steady  state,  an 
ergodic  approximation  over  the  N  most  recent  samples  yields: 

1  i 

EC  AX(tj^)AX(ti)T)  s  ^  CAx(tj)  Ai(tj)'^]  (4-36) 

Using  Eqs  (4-33)f  (4-35),  and  (4-36),  an  estimate  of  fipp  can 
be  made. 


ApD^ti)  =  -J"  CAX(tj)A  jt(tj)'^]  ♦  £(ti+) 

T 

-  ^F<ti,ti.i)£(ti.i)iF(ti,ti_i)  (4-37) 

Including  the  latter  two  terms  within  the  time  average  gives 
the  result 

1_  1 
**  Jsi-N+1 


fipDtti)  = 


{CAX(tj)Ax(tj)T]  ♦  £(tj  +  ) 


(4-38) 


-  •*F(tj,tj_i)£(tj_i)iF(tj,tj.i)} 

all  of  whose  terms  are  already  calculated  during  normal 
filter  updates  and  propagations.  This  finite  memory  result 
can  be  further  simplified  through  a  fading  memory 
approximation  in  order  to  reduce  storage  requirements. 
Specifically, 

SpoCti)  =  kQFD(ti_-|)  +  (1-k)  fipDlCti)  (4-39) 

where  flFDl(ti)  is  single  term  within  the  summation  in  Eq 
(4-38)  when  j  =  i.  The  parameter,  k,  is  what  determines  the 
responsiveness  of  this  estimate;  it  is  required  to  be 
between  0  and  1.  A  value  close  to  1  will  result  in  very 
little  weight  put  on  the  new  estimates  yielding  a  very 
slowly  responding  function.  In  contrast,  a  value  close  to  0 
will  cause  the  estimate  to  respond  rapidly.  As  the  value  of 
k  decreases;  however,  the  validity  of  the  variance 
approximation  of  the  residuals  'becomes  questionable  since  a 
shorter  time  average  is  being  employed.  Typically,  the 
value  of  k  is  0.8. 
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V.  Performance  Analysis  Methodology 

5.1  Introduction 

This  chapter  presents  the  methodology  used  to  test  the 
performance  of  the  extended  Kalman  filter  tracking 
algorithms  against  the  truth  model  used  to  represent  the 
real  world.  Since  the  real  world  constantly  changes, 
causing  no  two  experiments  eyer  to  be  exactly  the  same,  a 
Monte  Carlo  analysis  is  used  as  the  method  of  eyaluation. 
This  method  is  presented  in  the  first  section  of  this 
chapter.  Following  it  are  discussions  of  the  actual  figures 
of  merit  that  can  be  obtained  from  the  Monte  Carlo  analysis 
and  a  description  of  the  parameters  yaried  in  the  computer 
simulations . 

5.2  Monte  £ax:1£ 

In  essence,  a  Monte  Carlo  analysis  inyolyes  running 
numerous  sample-by-sample  simulations  of  a  single  truth 
model  trajectory  that  differs  from  run  to  run  only  by  the 
effects  of  the  noise  sources  within  the  model.  In  each 
simulation,  error  statistics  are  computed  between  desired 
quantities  of  the  truth  model  states  and  the  extended  Kalman 
filter  states.  Ideally,  an  infinite  number  of  simulations 
should  be  performed  in  order  to  ensure  that  sample 
statistics  are  a  true  representation  of  the  actual  error 
characteristics. 


However,  to  be  realist!.,  this  number  has  to  be  finite 
due  to  limited  computer  resources  available.  It  has  been 
shown  (Ref;  5;  12,  p  42)  that  20  simulations  is  sufficient 
to  indicate  the  convergence  of  the  error  statistics  of 
interest  for  this  problem  context.  In  this  research,  the 
number  of  simulations  had  to  be  limited  even  further,  to  one 
half  of  this  value,  due  to  extensive  time  requirements  of 
the  computer  simulation.  The  same  studies  indicated  a 
reasonable  convergence  of  the  error  statistics  at  this 
number  of  simulations  as  well.  In  any  event,  the  errors 
committed  at  any  one  sample  time  in  any  one  simulation  can 
be  determined  as  indicated  by  Figure  15  (Ref;  7f 
p  327;  16,  p  169). 


Truth 

Model 


Figure  15.  Generation  of  Error  Statistics 


The  truth  model  generates  the  measurement  process, 
from  the  driving  white  Gaussian  noise  and  from  information 
fed  back  from  the  filter  on  the  location  of  the  field  of 
view.  The  data  processing  algorithm  uses  realizations  of 
the  discrete  time  process,  z^ttifWk)  =  iT^^i),  at  each  time 
t^  to  generate  the  state  estimate  process,  £(*,•).  In  order 
to  related  the  critical  quantities  of  the  truth  model  states 
to  the  filter  state  estimates  the  following  linear  time- 
invariant  transformations  are  made: 

y(ti)  =  il£(ti)  (5-1) 

and 

X.j(tj^)  s  (5-2) 

where  Q.  and  selection  matrices  used  to  choose  the 

appropriate  states  for  comparison  purposes.  These  results 
can  then  be  combined  to  determine  the  filter  errors  before 
and  after  measurement  Incorporation  at  a  time  tj^  by 

fiT(ti”»*)  =  £(ti”’,’)  -  iT(ti»')  (5-3) 

and 

fiT(ti'^»*^  =  i(ti+,*)  -  XT(ti,*)  (5-4) 

5.3  Figures 

The  quantities  that  were  used  in  this  research  to 
characterize  the  filter's  tracking  performance  were  the 


errors  in  the  estimated  values  of  XpCt^-),  yD(ti+),  xpCtj.-), 

yD^ti  +  )»  *CEN  +  yCEN  V3{(ti+)»  Vy(tj^  +  ),  aj((tj^  +  ^* 

and  ay(tj^+).  Probably  the  most  important  estimate,  that  of 
the  dynamics  position,  was  evaluated  both  before  and  after 
measurement  updates  (in  most  cases)  in  order  to  determine 
how  well  the  internal  dynamics  model  and  the  measurement 
data  processing  algorithm  performed.  The  remaining 
estimates  were  only  evaluated  after  measurement 
incorporation  to  limit  the  amount  of  analysis  required  for 
each  Monte  Carlo  study.  Statistics  calculated  in  the  error 
processing  routines  of  the  computer  code  Include  the 
ensemble  error  means  and  the  error  variances  of  these 
variables  at  each  time  frame  of  the  simulations.  An  example 
of  a  calculation  of  the  mean  error  is 


1  N 
N  k=1 


(xx  -  Xd"  ^ 
Dik  ik 


(5-5) 


where 


=  mean  error  (ensemble  average  over  all 
Dj.  simulations)  of  x  dynamics  prior  to  the 
measurement  update  at  time  tj^ 

XX  -  value  of  the  truth  model  x  dynamics  state 
Dik  for  frame  1  and  simulation  k 

xq-  =  value  of  the  filter  estimates  x  dynamics 
ik  state  for  simulation  k  prior  to  the 
measurement  update  at  time  ti 

N  =  the  number  of  simulations  performed 


with  the  variance  of  the  error  given  by 


similar  equations  can  be  written  for  the  remaining 
quantities  of  interest.  The  results  of  equations  such  as 
Eqs  (5-5)  and  (5-6)  were  then  used  by  the  plotting  routine 
to  generate  two  different  types  of  plots.  The  first  type 
displays  the  mean  error  along  with  the  mean  error  plus/minus 
the  error  standard  deviation  at  each  sample  time  within  the 
five  second  simulation.  The  second  plot  used  to  analyze 
filter  performance  compares  the  filter's  estimate  of  the 

standard  deviation  of  its  own  errors  (  Pjj(ti)  ^  to  a 
quantity,  defined  here  as  the  "true"  root-mean-square  (RMS) 
error,  that  reflects  the  magnitudes  of  both  the  true  mean 
error  and  the  true  standard  deviation.  The  RMS  error  is 
expressed  as 


where  E  and  o  are  as  defined  by  Eqs  (5-5)  and  (5-6)  except 
that  the  subscript  J  now  represents  the  particular  quantity 
of  interest.  Samples  of  the  plots  are  shown  in  Figures  16 
and  17> 

The  data  was  further  processed  by  the  plot  routine  to 
determine  the  time-averaged  mean  error  along  with  the  time 
averaged  error  variance  over  the  portions  of  the  simulations 


FILTER  ERROR  OF  X  PLUS  POS 


TIME  <SEC) 


FILTER  ERROR  OF  X  PLUS  POS 

NRUNS-10  ITARG-2  VAROF- 300.0 


in  which  transient  effects  due  to  acquisition  and/or  a 
change  in  target  dynamics  had  diminished.  Also  determined 
was  the  peak  error  over  the  entire  engagement.  These 
results  are  displayed  in  the  tables  presented  in  the  next 
chapter. 


5.4  Variation  a£  Parametera 


In  order  to  allow  flexibility  in  testing  the  extended 
Kalman  filter  tracking  algorithms,  the  computer  simulation 
is  set  up  to  allow  variation  of  many  of  the  parameters  that 
describe  the  filter  design  characteristics  as  well  as  the 
tracking  environment.  In  the  actual  computer  simulation, 
parameters  are  controlled  by  choosing  the  appropriate  input 
data  at  the  end  of  the  computer  code  shown  in  Appendix  G. 
Following  is  4i  description  of  these  parameters  and  the 
different  values  Implemented.  Tables  that  relate  sets  of 
parameter  values  to  corresponding  performance  plots  are 
Table  D-1  and  Table  E-l  for  the  GM  and  CTR  filters 
respectively. 

One  of  the  most  critical  factors  used  to  describe  the 
tracking  environment  is  the  trajectory  being  simulated. 
This  is  partially  controlled  by  the  initial  position, 
velocity,  and  acceleration  values  of  the  target  dynamics 
specified  in  the  inertial  reference  frame.  The  initial 
target  position  for  all  simulations  was  chosen  to  be 
^^opyot^o^  '  (5000,500,20000)  meters.  From  this  point  in 
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inertial  space,  a  constant  velocity  trajectory  was  simulated 
until,  in  some  cases,  a  constant  G  pull-up  or  a  constant  G 


turn  was  Initiated.  Specifically,  four  different 
trajectories  were  simulated  as  indicated  in  Table  5.1. 


Table  5.1  Target  Trajectories  Simulated 


Case 

Initial 

Position 

Initial 

Velocity 

Initial 

Acceler¬ 

ation 

Maneuver 

1 

X  =  5000 
y  =  500 
z  s  20000 

V-  =  -1000 

Vy  =  0 

Vz  =  0 

®x  ~  ® 

ay  =  0 

ai  r  0 

constant 

velocity 

trajectory 

2 

X  s  5000 
y  s  500 
z  s  20000 

Vjj  -  -1000 

Vy  S  0 

vj  =  0 

ax  =  0 

ay  s  0 

ai  =  0 

constant  G-pull- 
up  in  J  direc¬ 
tion  at  t  s  2.0 
seconds 

3 

X  s  5000 
y  =  500 
z  s  20000 

Vx  =  -700 

Vy  =  -300 
v'  =  500 

®x  =  0 

ay  =  0 

az  r  0 

constant 

velocity 

trajectory 

4 

X  s  5000 
y  =  500 
z  =  20000 

Vx  =  -1000 

Vy  S  0 

vj  =  0 

ay  5  0 
aC  =  0 
az  0 

constant  G  turn 
in  k  direction  at 

t  s  2.0  seconds 

The  first  three  cases  in  Table  5.1  were  discussed  in  greater 
detail  in  Chapter  III,  while  the  fourth  case  is  identical  to 
the  second  except  for  the  direction  of  the  constant-G 
maneuver.  The  first  and  third  trajectories  are  relatively 
benign  and  are  used  to  determine  basic  filter  performance. 


The  remaining  two  involve  significant  changes  in  target 
dynamics.  To  a  large  degree,  the  dynamics  of  Trajectory  2 
remain  in  the  plane  perpendicular  to  the  line  of  sight. 
Trajectory  4  involves  a  maneuver  away  from  this  plane. 
Also,  compared  to  that  of  Trajectory  2,  the  tracker  is 
exposed  to  a  different  target  image  in  Trajectory  4. 
Particular  maneuvers  are  further  described  by  specifying  the 
number  of  Gs,  the  roll-rate,  as  well  as  the  maneuver 
Initiation  times.  Values  of  0,  2,  and  5  were  used  in  the 
constant-G  maneuvers  while  0.0,  0.5,  1.0,  and  2.0  were  used 
as  constant  roll-rates.  An  important  parameter  used  in  the 
computer  code  to  describe  the  target  is  the  target  selection 
flag.  This  parameter  determines  whether  the  target  to  be 
tracked  will  produce  a  single  or  multiple  hot-spot  image 
with  a  static  or  dynamic  image  profile.  Setting  this  flag 
equal  to  0  will  produce  a  multiple  hot-spot  image  with  three 
hot-spots  (each  individually  displaying  circular  equal- 
intensity  contours)  fixed  in  relation  to  one  another  on  the 
image  plane  as  shown  in  Figure  18.  In  contrast,  a  value  of 
1  again  produces  a  multiple  hot-spot  image  (see  Figure  19); 
however,  now  the  three  spots  will  move  about  with  respect  to 
one  another  and  change  sizes  and  shapes  according  to 
realistic  projections  of  3-dimensional  targets  onto  the  FLIR 
image  plane.  In  this  case,  provisions  were  also  made  for 
portions  of  the  target,  and  the  corresponding  hot-spots,  to 
be  obscured  from  the  view  of  the  sensor.  Finally,  when  the 
target  flag  equals  2  a  single  hot-spot  is  produced  with 


circular  equal-intensity  contours.  When  this  flag  is  either 
0  or  2,  the  individual  Gaussian  intensity  distributions  are 
described  by  a  glint  dispersion  parameter,  of  either 
2.0  or  3>0.  In  contrast,  when  the  flag  is  1,  a  more 
detailed  description  of  the  target  image  is  possible.  Four 
arrays  (Oyo*  ®pvo»  ®v*  and  «pv^  ®ach  containing  three 
elements  apiece  (units  of  pixels),  are  used  to  specify  the 
size,  shape  and  relative  orientation  of  the  three 
corr :isponding  bivariate  Gaussian  intensity  hot-spots  at  a 
reference  range  of  20000  meters.  These  values  specify  the 
maximum  possible  image  dimensions  when  the  target  is  located 
at  the  Indicated  reference  range.  The  values  were  set  to 
constants  for  all  simulations.  Specifically,  «v  *  (0.64,  - 
0.86,  -0.86)  represents  the  maximum  pixel  distance  from  the 
centroid  location  to  the  peaks  of  the  three  hot-spots  on  the 
FLIK  image  plane  in  the  direction  of  the  Image's  velocity 
vector.  Similarly,  «py  s  (o.O,  2. 5, -2. 5)  describes  equiva¬ 
lent  distances  in  the  direction  perpendicular  to  the 
velocity  vector.  In  addition,  the  array  s  (4.0,  1.5, 
1.5)  contains  the  possible  dispersions  of  the  three  Gaussian 
intensity  distributions  along  the  velocity  direction  of  the 
target  image.  Similarly,  *pvo  ”  ‘••O*  ‘l•0)  describes 
the  image  dispersions  in  the  direction  perpendicular  to  the 
velocity.  Figures  10  and  11  describe  the  relationship  of 
these  parameters. 

Other  parameters  that  further  characterize  the  tracking 
environment  are  the  maximum  signal  intensity,  the  variance 


of  the  spatially  correlated  background/FLIR  noise,  and  the 
standard  deviation  of  the  truth  model  atmospheric  jitter. 
In  essence  the  parameter  used  to  represent  the  total  noise 
corruption  of  the  measurement  data  is  chosen  to  reflect  both 
FLIR  and  background  noises;  however,  it  should  be  noted  that 
true  FLIR  noise  is  not  spatially  correlated.  The  truth 
model  background  noise  variance  along  with  the  maximum 
signal  intensity,  determine  the  signal  to  noise  ratio  (SNR) 
of  the  target  image.  Specifically, 

S  Imax  -  mean  background  noise  _  Imax  ^ 

N  “  RMS  value  of  background  noise  ”  a^2 

when  the  noise  is  zero  mean.  The  superior  performance  of 

Kalman  filter , trackers  over  standard  correlator  trackers  in 

low  signal  to  noise  environments  has  been  demonstrated 

• 

repeatedly  (Ref:  5,  12).  Therefore,  the  parameters  in 
Eq  (5-8)  were  chosen  in  order  to  produce  a  signal  to  noise 
ratio  of  20  in  all  simulations  which  is  a  reasonable  value 
in  realistic  scenarios.  Additional  parameters  held  constant 
throughout  most  of  the  research  included  the  standard 
deviation  of  the  true  atmospheric  jitter  at  0.1414  and  the 
variance  of  the  filter  atmospherics  at  0.2.  It  was  desired 
that  these  two  parameters  model  equivalent  atmospheric 
effects;  however,  an  oversight  early  in  the  research 
resulted  on  the  use  of  these  values. 

In  addition  to  the  variance  of  the  filter  atmospherics, 
other  parameters  that  specify  filter  design  characteristics 


include  the  variance  of  the  filter  dynamics  driving  noise, 
the  smoothing  constant  used  in  exponential  smoothing,  the 
number  of  zeros  padded,  and  the  number  of  high  frequency 
components  zeroed  in  the  data  processing  algorithm  used  to 
generate  the  target  reference  image.  The  strength  of  the 
filter  dynamics  driving  noise,  <^d^,  reflects  the  level  of 
the  target  maneuvering  ability  and  the  uncertainty  in  the 
filter  dynamics  model.  It  is  used  in  order  to  tune  the 
filter  for  optimal  tracking  performance.  The  weighting 
factor  of  the  exponential  smoothing  algorithm,  a  ,  is 
discussed  in  Section  2.3  Exponential  Smoothing.  This 
parameter  is  of  particular  interest  when  image  variations 
due  to  changing  size  and  shape  become  significant.  Values 
used  in  this  research  included  0.1,  0.2,  and  0.5. 

The  remaining  parameters  that  specify  filter  design 
characteristics  affect  the  measurement  processing  portion  of 
the  algorithm.  It  was  indicated  in  Chapter  II  than  an  array 
of  size  24x24  is  processed,  as  opposed  to  the  8x8  FOV,  in 
order  to  reduce  problems  associated  with  taking  FFTs  of 
finite  size  data  arrays.  A  common  practice  would  be  simply 
to  surround  the  8x8  FOV  array  with  eight  rows  and  columns  of 
zeros  (i.e.,  a  value  of  8  for  the  zero  padding  parameter); 
however,  this  practice  induces  artificial  high  frequencies 
and  edge  effects  especially  when  the  actual  target  intensity 
function  is  not  practically  zero  at  the  FOV  boundaries. 
Such  problems  are  reduced  if  the  FOV  is  padded  with  an 
equivalent  amount  of  measurement  data  (i.e.,  a  value  of  0 


for  the  zero  padding  parameter).  Such  a  luxury  exists  in 
this  application  due  to  the  large  size  of  the  actual  FLIR 
measurement  array  available.  An  alternative  would  be  to  pad 
with  zeros  and  then  perform  high  frequency  spatial  frequency 
filtering.  This  is  done  by  specifying  the  number  of  high 
frequencies  to  be  set  to  zero  within  the  Fourier  Transform 
of  the  image  that  is  performed  during  the  derivation  of  the 
intensity  profile.  It  should  be  noted  that  spatial 
frequency  fltlering  may  enhance  or  corrupt  tracking 
performance,  depending  upon  the  measurement  noise  and  the 
characteristics  of  the  true  target  profile.  Specifically, 
if  the  target  image  is  smooth  and  shallow  relative  to  the 
edge  and  noise  effects,  high  frequency  filtering  will 
enhance  tracking  performance.  In  contrast,  if  the  image 
displays  sharp  intensity  variations  filtering  will  produce 
errors  in  the  resulting  reference  image  and  likely  degrade 
tracking  performance.  Thus,  the  number  of  frequencies 
zeroed  and  number  of  zeros  padded  parameters  were  set  to  0 
for  all  simulations  so  as  not  to  mask  the  effects  of  other 
parameters  on  filter  performance. 

The  final  parameters  specified  in  each  computer 
simulation  are  the  number  of  frames  per  simulation  and  the 
number  of  runs  in  the  Monte  Carlo  analysis.  A  value  of  150 
was  used  as  the  number  of  frames  in  order  to  produce  a  five 
second  simulation  of  measurements  being  received  at  a  30  Hz 


rate.  Finally,  the  number  of  runs  per  Monte  Carlo 


simulation  was  limited  to  10  due  to  the  large  amount  of  CPU 
time  required  per  simulation. 

5.5  Summacz 

In  review,  this  chapter  presented  the  methodology 
used  to  conduct  a  performance  analysis  of  the  extended 
Kalman  filter  tracking  algorithms.  The  specific  means  of 
evaluation  is  a  Monte  Carlo  analysis  which  computes  the 
statistics  of  the  filter  estimates  both  before  and  after 
measurement  incorporation  at  each  time  frame.  The  figures 
of  merit  determined  at  each  time  frame  for  a  quantity  of 
interest  include  the  mean  error  and  variance  of  that  error, 
the  filter's  estimate  of  its  own  error  variances,  and  the 
true  RMS  error.  After  transients  have  died  out,  iime 
averaged  mean  and  standard  deviations  are  determined  to  give 
quick  numerical  Insights  into  the  overall  perfoi  mance  of  the 
filter.  Peak  errors  are  also  determined  over  the  same 
interval.  The  final  portion  of  this  chapter  describes  the 
input  parameters  used  to  specify  the  tracking  environment 
and  filter  design  charactersitics.  The  range  of  values  used 
for  these  parameters  are  also  listed  there. 


VI.  fi£8»IJfea 


6.1  Introduction 

This  chapter  presents  the  results  of  the  performance 
analysis  conducted  on  both  the  first  order  Gauss-Markov  (GM) 
acceleration  and  constant  turn-rate  (CTR)  acceleration 
extended  Kalman  filters.  Also  presented  is  a  review  of  the 
performance  of  the  adaptive  Brownian  Motion  (BM) 
acceleration  extended  Kalman  filter  (using  an  h  derived  on 
the  basis  of  a  bivariate  Gaussian  intensity  function) 
previously  developed  by  Captains  Harnly  and  Jensen  (Ref:  5). 
Of  particular  interest,  is  the  performance  of  this 
particular  filter  in  the  prewence  of  a  multiple  hot-spot 
image.  In  Section  6.2,  the  importance  of  modelling  the 
spatial  correlations  in  the  measurement  noise  is  examined  by 
comparing  performance  of  the  GM  filter  with  the  spatial 
correlations  modelled  to  that  without  the  correlations 
modelled.  Section  6.3  then  contrasts  the  BM,  GM  and  CTR 
filters  in  the  case  of  relatively  benign  trajectories,  with 
targets  displaying  single  hot-spot  images  as  well  as 
multiple  hot-spot  images.  Then  the  performances  of  the 
three  filters  are  examined  when  the  target  undergoes  dynamic 
maneuvers  such  as  constant  G  turns  and  constant  roll-rate 
maneuvers.  The  cases  displaying  the  GM  and  CTR  filters  also 
Involve  the  dynamic  image  profile  developed  in  this 
research.  Finally,  in  Section  6.5  the  efforts  to  implement 


the  estimation  of  the  dynamic  driving  noise  matrix  are 
discussed.  The  performance  plots  associated  with  the  Gauss- 
Markov  filter  are  presented  in  Appendix  D  with  Table  D.1 
displaying  the  parameters  of  the  various  cases  at  the 
beginning  of  the  appendix.  Similarly,  the  plots  of  the 
constant-turn-rate  filter  appear  in  Appendix  E,  and  the 
plots  of  Harnly  and  Jensen's  filter  in  Appendix  F.  Unless 
otherwise  specified,  the  parameter  values  are  the  standard 
parameters  as  listed  in  the  previous  chapter.  Tables  6.1 
and  6.2  present  the  figures  of  merit  of  all  the  cases 
involving  the  Gauss-Markov  and  constant-turn-rate  filters  in 
regard  to  the  dynamics  and  centroid  position  tracking 
errors.  The  averaging  done  to  obtain  the  figures  in  these 
tables  was  performed  after  transients  had  died  out.  In  the 
case  of  constant  velocity  trajectories,  the  averaged 
interval  began  0.5  seconds  after  simulation  initiation.  For 
cases  involving  constant  G  maneuvers  initialized  two  seconds 
after  simulation  initiation,  the  interval  over  which 
averaging  was  performed  was  the  last  two  seconds  of  the 
simulation  (i.e.,  starting  one  second  after  maneuver 
initiation).  Parameters  pertaining  to  these  cases  are 
specified  in  Tables  D.1  (for  cases  1  through  11)  and  E.1 
(for  cases  12  through  24). 

6.2  Modelling  Spatial  Correlationa 

As  discussed  in  Chapter  3,  the  combined  effects  of  FLIR 
and  background  noises  were  modelled  as  spatially  correlated, 
zero  mean,  white,  Gaussian  noise  of  strength 


In  an 


Table  6.1  Time  Averaged  Figures  of  Merit 
Dynamics  Position  Estimates 


annel  Dynamics 


Error  Error 


hannel  Dynamics 


-.339 

-.173 

.194 

.163 

.084 

.227 

-.366 

-.187 

.391 

-.205 

-.068 

.377 

1  .291 

.149 

.509 

-.4o4 

-.249 

.429 

(M 

• 

.162 

.509 

-.411 

-.254 

.429 

5 

-.462 

-.291 

.466 

.120 

.041 

.609 

6 

.272 

.027 

.160 

-.212 

-.039 

.126 

7 

-.233 

-.042 

.190 

-.148 

-.024 

.117 

8 

-.233 

-.002 

.189 

-.i73 

-.048 

.115 

9 

.378 

.184 

.148 

-.379 

-.247 

.163 

10 

.310 

.174 

.132 

-.114 

.005 

.123 

11 

-.239 

-.070 

*125 

-.141 

-.004 

.132 

12 

.149 

.090 

.199 

-.175 

-.042 

.229 

13 

-.229 

-.106 

.266 

.137 

.056 

.372 

14 

-.169 

-.029 

.184 

.108 

.038 

.219 

1 

15 

.440 

.369 

.156 

-.075 

-.007 

.093 

16 

.403 

.325 

.159 

-.079 

.002 

.094 

17 

.313 

.226 

.139 

-.604 

-.495 

.376 

18 

.435 

.334 

.168 

.183 

.063 

.133 

19 

.274 

.207 

.136 

-.127 

-.016 

.124 

20 

.402 

.239 

.167 

-.186 

-.071 

.117 

21 

.539 

.341 

.151 

-.284 

-.100 

.163 

22 

.644 

.377 

.190 

-.240 

-.091 

.136 

23 

-.138 

-.088 

.213 

-.125 

-.038 

.251 

24 

.513 

.419 

.161 

-.163 

-.048 

.138 

r» 


Table  6.2  Time  Averaged  Figures  of  Merit  - 
_ Centroid  Position  Estimates _ 


X  Channel  Centroid _ y  Channel  Centroid 


Case 

Peak 

Error. 

Mean 

Error 

Stand. 

Dev. 

Peak 

Error 

Mean 

Error 

Stand. 

Dev. 

1 

-.211 

-.148 

.171 

.126 

.076 

.199 

2 

-.220 

-.161 

.373 

-.138 

-.076 

.353 

3 

-.099 

-.026 

.495 

-.262 

-.181 

.410 

4 

-.100 

-.023 

.495 

-.265 

-.183 

.410 

5 

-.296 

-.266 

.445 

.092 

.033 

.597 

6 

.202 

.058 

.143 

-.149 

-.048 

.078 

7 

-.121 

-.016 

.166 

-.073 

-.032 

.044 

8 

.133 

.024 

.163 

-.091 

-.056 

.048 

9 

.310 

.152 

.136 

-.138 

-.125 

.075 

10 

.074 

.026 

.075 

-.033 

-.015 

.049 

11 

-.107 

-.045 

.081 

-.076 

-.012 

.084 

12 

.141 

.073 

.176 

-.091 

0 

• 

1 

.205 

13 

,  -.191 

00 

• 

1 

.242 

.112 

.056 

.362 

14 

-.148 

-.079 

.161 

-.090 

.038 

.193 

15 

.401 

.313 

.145 

-.046 

-.011 

.054 

16 

.366 

.280 

.145 

.045 

.001 

.051 

17 

.376 

.297 

.160 

-.563 

-.531 

.391 

18 

.391 

.291 

.142 

.136 

.065 

.049 

19 

.102 

.070 

.076 

-.035 

-.014 

.047 

20 

.285 

.190 

.143 

-.175 

-.072 

.061 

21 

.483 

.291 

.125 

-.186 

-.101 

.128 

22 

.522 

.327 

.166 

-.219 

-.092 

.088 

23 

-.169 

-.144 

.213 

-.088 

-.051 

.249 

24 

.425 

_ t325 _ 

.127 

-.063 

.082 

r;  effort  to  determine  the  sensitivity  of  the  filter's 

performance  to  its  model  of  such  noise,  runs  were  made  in 
which  the  measurement  noise  was  portrayed  by  the  filter  to 
be  spatially  correlated  as  well  as  in  which  it  was  modelled 
as  spatially  uncorrelated  noise.  In  both  cases,  the 
strength  of  the  filter-assumed  noise  was  chosen  as  twice  the 
value  of  the  actual  (truth  model)  noise  strength  in  order  to 
reflect  uncertainty  in  the  internal  model,  providing 
reasonably  good  filter  tuning.  The  two  cases  of  interest 
were  plotted  for  the  filter  with  the  Gauss-Markov 
acceleration  model  (cases  1  and  2  of  Table  D.1)  in  which  a 
target  with  a  single  spot  image  travelled  along  Trajectory  1 
of  Table  5.1.  The  plots  corresponding  to  spatially 
[T  correlated  noise  (case  1)  are  shown  in  Figures  D.1  through 

D.14  while  those  with  spatially  uncorrelated  noise  (case  2) 
are  shown  in  Figures  D.15  through  D.20.  Comparison  of  these 
plots  indicates  the  significance  of  correctly  modelling  the 
spatial  correlations.  Examining  the  peak  and  time  averaged 
mean  errors  of  the  position  estimates  of  both  cases  (Table 
6.1)  indicates  only  slight  increase  in  the  magnitudes  of  the 
errors  in  either  x  or  y  channel  of  less  than  0.05  pixels 
(although  the  y  channel  does  change  sign).  However,  there 
is  substantial  degradation  of  the  time  averaged  standard 
deviation  of  the  errors  when  spatial  correlations  are 
unmodelled.  The  standard  deviation  increases  by  more  than 
100$.  (0.2  pixels)  in  the  x  channel  and  65$  (0.15  pixels) 

in  the  y  channel.  Although  they  were  not  plotted  in  this 


2 


case,  such  increases  make  the  RMS  errors  of  the  position 
estimates  exceed  the  envelope  formed  by  the  filter  Indicated 
error  deviations.  In  order  to  obtain  good  filter  tuning,  it 
is  desired  that  the  true  RMS  errors,  as  described  by  Eq  (5- 

7),  remain  within  the  envelope  formed  by  the  Pjj(ti^ 
values. 

Since  failure  to  model  spatial  correlations  seriously 
degrades  tracking  performance,  the  majority  of  the  simula¬ 
tions  in  this  research  contain  the  filter  model  of  spatial 
correlations  within  the  measurement  noise  with  a  strength 
that  is  twice  the  true  noise  strength.  This  value  was  not 
the  result  of  tuning  accomplished  in  this  research,  but 
rather,  was  chosen  for  use  in  comparison  with  the  tuned  BM 
filter  previously  developed.  Tests  were  not  made  with 
respect  to  unmodelled  spatial  correlations  in  the  filter 
containing  the  constant  turn-rate  acceleration  model;  how¬ 
ever  it  can  be  expected  to  respond  similarly  since  the 
measurement  portions  of  both  filters  are  identical.  It 
should  be  noted  that  the  signal  to  noise  ratio  (SNR),  as 
defined  by  Eq  (5-8),  in  these  cases  was  a  value  of  20. 
Thus,  the  dependence  of  the  CM  and  CTR  filters  on  accurately 
modelling  the  spatial  correlations  of  the  background  noise 
is  in  direct  contrast  to  the  results  obtained  for  the  BH 
filter  at  this  SNR.  Harnly  and  Jensen  showed  that  the 
presence  of  unmodelled  spatial  correlations  was  important  at 
low  SNRs,  but  of  little  consequence  when  the  SNR  was  as  high 


Therefore,  In  the  tracking  environment  with  a  single 
hot-spot  target  image,  the  BM  filter  is  much  more  robust  (in 
regard  to  sensitivity  to  spatial  correlations  in  the 
background  noise)  than  either  of  the  two  filters  developed 
in  this  research.  As  a  result,  when  all  filters  are  given 
the  same  spatial  correlation  model,  the  BM  filter  can  be 
expected  to  perform  best  under  conditions  where  the  true 
correlations  vary  and/or  are  not  modelled  correctly. 

6.3  Filter  Comparisflua 

This  section  will  contain  comparisons  of  the  basic 
tracking  performance  of  the  filters  with  the  first  order 
Gauss-Markov  acceleration  model,  the  constant  turn-rate 
acceleration  model,  as  well  as  Harnly  and  Jensen's  Brownian 
motion  acceleration  model.  Initially,  performance  in  the 
presence  of  a  single  hot-spot  image  with  circular  equal- 
intensity  contours  will  be  discussed.  This  is  followed  by 
the  performance  of  the  filters  when  the  target  image  con¬ 
sists  of  the  combination  of  three  hot-spots,  fixed  in 
relation  to  one  another,  each  of  identical  maximum  intensity 
(SNR  s  20),  with  each  individually  presenting  circular 
equal-intensity  contours.  Elliptical  contours  were 
implemented  in  the  cases  involving  dynamic  image  variations 
with  the  results  discussed  in  section  6.4. 


6.3.1  Single  Hot-Spot  Image.  Trajectory  3  of  Table 
5.1  was  used  to  compare  tracking  performance  of  the  filters 


against  the  single  hot-spot  Image.  The  Image  Is 
characterized  by  a  SNR  of  20,  a  Gaussian  glint  dispersion 


parameter,  Og^»  of  value  3,  and  circular  equal-intensity 
contours.  The  variance  of  the  dynamics  driving  noise, 
was  either  160  or  300  where  the  two  values  were  considered 
for  tuning  purposes.  The  trajectory  Itself  Is  benign  In  the 
sense  that  the  magnitude  of  the  Inertial  acceleration  Is 
zero;  however,  there  Is  significant  target  motion  along  the 
range  unit  vector  (In  Inertial  space)  which  Is  unmodelled  by 
the  filters  examined  In  this  research.  When  a  dynamic  Image 
Is  being  observed  on  the  Image  plane  (such  results  are 
discussed  In  section  6.4)  motion  along  the  range  unit  vector 
creates  changing  size  effects  as  well  as  an  unmodelled 
rotation  of  the  tracker  coordinate  system  as  the  target  gets 
closer.  These  effects  were  not  present  In  cases  discussed 
In  this  section  since  they  all  utilized  a  static  target 
Image.  However,  what  the  filter  Is  actually  estimating.  In 
either  type  of  Image,  Is  the  dynamics  of  the  target  In  the 
plane  perpendicular  to  the  line  of  sight.  Since  portions  of 
these  parameters  are  dependent  on  range  dynamics,  these 
contributions  are  unmodelled  by  any  of  the  filters’  dynamics 
models.  For  example,  the  true  planar  acceleration 
perpendicular  to  the  LOS  Includes  a  component  that  Is 
proportional  to  the  radial  velocity  of  the  target.  This 
along  with  other  unmodelled  components  can  cause  biases  In 
the  state  estimates.  The  results  of  the  overall  performance 
of  the  Individual  filters  Is  sumarlzed  In  Table  6.3. 
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Table  6.3  Time  Averaged  Error  Statistics  when 
Tracking  a  Single  Hot-Spot  Image 


Filter 

Model 

X  Dynamics  Position 

y  Dynamics  Position 

Peak 

Error 

Mean 

Error 

Std. 

Dev. 

Peak 

Erro-" 

Mean 

Error 

Std. 

Dev. 

BM 

®d^  = 

160 

.12 

,00 

.17 

.12 

.00 

.17 

GM 

160 

.291 

.149 

.509 

-.404 

-.249 

.429 

GM 

300 

.312 

.162 

.509 

-.411 

-.254 

.429 

CTR 

160 

.149 

.090 

.199 

-.175 

-.042 

.229 

Along  with  the  plots  in  Figures  F-1  through  F-8,  Table  6.3 
indicates  that  Harnly  and  Jensen's  adaptive  filter,  with  its 
Brownian  Motion  acceleration  model,  is  essentially  unbiased 
in  both  channels  with  peak  errors  and  standard  deviations  of 
less  than  0.2  pixels.  It  should  be  noted,  however,  that 
when  this  run  was  made,  the  maneuver  indicator  that  Harnly 
and  Jensen  Implemented  was  triggered  several  times.  The 
purpose  of  the  maneuver  indicator  is  to  detect  the  beginning 
of  a  harsh  maneuver  and  then  to  increase  the  Kalman  filter 
gains  directly  and  to  reprocess  the  state  estimate  with  the 
higher  gains.  Activation  of  the  maneuver  indicator  can  be 
identified  by  observing  the  sharp  increases  in  the  filter 
sigma  estimates  of  the  velocity  states.  Although  use  of 
this  indicator  is  an  ad  hoc  procedure,  and  not  part  of  their 
basic  filter  model,  the  maneuver  indicator  should  not  have 


been  triggered  since  no  change  in  target  dynamics  occurred. 
It  is  felt,  and  will  be  discussed  subsequently,  that  these 
activations  are  related  to  a  sensitivity  to  the  noise  values 
generated  through  the  use  of  pseudorandom  codes. 

In  regard  to  the  performance  of  the  Gauss-Markov  filter 
studied  in  this  research,  it  can  be  seen  from  the  entries  in 
Table  6.3  and  the  plots  of  Figures  D-21  through  D-32  that 
the  nonzero  biases  and  error  standard  deviations  on  the 
order  of  0.5  pixels  in  the  position  estimates  cause  the  RMS 
position  errors  to  exceed  the  filter  sigma  envelopes  by  as 
much  as  0.2  pixels  on  a  consistent  basis.  When  this 
performance  was  observed  for  s  160,  attempts  were  made 
to  tune  the  filter  further.  However,  within  the  inverse 
covariance  update  (Eq  (4-27))  the  eigenvalues  of  £“  1 
corresponding  to  the  dynamics  position  states  are  dominated 
by  Thus,  increasing  to  300  does  not  affect  the 

one-sigma  envelope  or  Increase  the  gains  associated  with  the 
position  states  (see  plots  in  Figures  D-33  through  0-36). 
In  fact,  performance  was  slightly  degraded  by  increasing 
This  indicates  that  further  tuning  of  the  position 
states  should  be  done  by  varying  £  (op^)*  The  biases 
present  can  be  attributed,  at  least  to  some  degree,  to  the 
motion  of  the  target  that  is  unmodelled  by  the  filter. 

In  contrast,  the  constant  turn-rate  filter  displays 
much  smaller  biases  and  standard  deviations  as  indicated  by 
the  statistics  in  Table  6.3  and  shown  by  the  position  plots 
in  Figures  E-1  through  E-4  (x  channel)  and  in  Figures  E-5 


through  E-6  (y  channel).  This  improvement  further  indicates 
that  the  dynamics  portion  of  the  Gauss-Markov  filter  is 
responsible  for  a  large  degree  of  the  error  in  that  filter's 
estimates.  The  distinct  difference  in  the  two  dynamics 
models  is  Illustrated  by  examining  the  corresponding 
velocity  and  acceleration  plots.  The  Gauss-Markov  velocity 
plots  are  essentially  unbiased  while  the  acceleration  plots 
display  large  biases.  On  the  other  hand,  the  constant  turn- 
rate  plots  are  characterized  by  just  the  opposite  since  this 
dynamics  model  is  a  much  more  accurate  rer  esentation  of  the 
actual  accelerations  of  the  target  image. 

6.3.2  Three  Hot-Spot  Image.  To  contrast  filter 

performance  in  the  previous  scenario,  a  much  more  complex 

target  image  was  presented  to  the  same  three  filters.  The 

image  Itself  is  static  except  for  the  presence  of  background/ 

measurement  noise.  The  individual  spots  of  the  image  are 

bivariate  Gauslan  intensity  distributions  with  circular 

equal-intensity  contours  each  with  glint  dispersion 

parameter,  «  g^»  value  2.0.  This  particular  image  is 

displayed  in  Figure  18  in  the  previous  chapter.  The 

trajectory  used  to  test  filter  performance  against  this 

image  is  Trajectory  1  of  Table  5.1  in  which  the  target 

♦ 

exhibits  a  constant  velocity  in  the  -1  direction.  The 
statistical  results  of  the  position  estima  ?s  for  the 
overall  simulation  are  presented  in  Table  6.4  for  each  of 
the  three  filters.  In  all  cases  the  variance  of  the  filter 
dynamics  driving  noise,  was  300, 


Table  6.4  Filter  Performances  with  a 
Multiple  Hot-Spot  Image 


x+ 

D 

Dymanlcs 

Position 

''S 

Dynamics 

Position 

Filter 

Model 

Peak 

Mean 

Error 

Time 

Ave 

Mean 

Error 

Time 

Ave 

Stand. 

Dev. 

Peak 

Mean 

Error 

Time 

Ave 

Mean 

Error 

Time 

Ave 

Stand . 
Dev. 

BM 

0.25 

0.00 

1.3 

-0.81 

-0.70 

0.20 

BM» 

±0.70 

0.00 

0.95 

-0.60 

-0.40 

0.37 

GM 

-0.46 

-0.29 

0.47 

0.12 

0.04 

0.61 

CTR 

-0.23 

-0.11 

0.27 

0.14 

0.06 

.37 

*Maneuver  indicator  enabled 

The  plots  corresponding  to  the  results  of  the  first  case 
displayed  in  Table  6.4,  for  Harnly  and  Jensens  adaptive 
filter,  are  shown  in  Figures  F-9  through  F-16.  They 
indicate  that  this  filter’s  typical  performance  is  seriously 
degraded.  Although  the  x  channel  position  and  velocity 
estimates  are  relatively  unbiased,  the  standard  deviation  of 
the  actual  errors  is  over  five  to  six  times  greater  than  the 
filter  indicated  errors.  In  contrast,  the  y  channel 
exhibits  a  standard  deviation  similar  to  the  previous 
scenario  (results  in  Table  6.3)  while  the  position  estimate 
experienced  a  bias  of  about  -0.7  pixels.  The  difference  in 
behavior  of  the  two  channels  can  be  attributed  to  the  fact 
that  almost  all  of  the  image  plane  dynamics  is  in  the  x 
direction.  Thus  there  is  likely  to  be  more  variation 


between  the  filter  predicted  x  location  and  the  true  x 


location.  Another  characteristic  of  the  filter’s 
performance  was  its  formulation  of  a  reference  profile 
corresponding  to  a  single  hot-spot  image  with  a  maximum 
intensity  that  was  consistently  equal  to  40  (as  opposed  to 
the  true  value  of  20  for  each  spot).  In  addition,  the 
estimated  one-sigma  image  dispersion  estimates  ranged 
anywhere  from  5  to  6  in  the  velocity  direction  with  an 
estimated  aspect  ratio  typically  from  3  to  4. 

In  an  effort  to  see  how  activation  of  the  maneuver 
indicator  might  affect  filter  tracking  of  the  three  spot 
image,  a  case  was  performed  with  the  Indicator  enabled.  The 
results  in  Table  6.4  (second  set  of  entries)  and  the  plots 
in  Figures  F-17  through  F-24  display  quite  different 
characteristics  than  in  the  previous  case.  Although  the 
standard  deviations  of  the  errors  of  the  x  channel  position 
and  velocity  remained  comparable;  the  mean  error,  which 
remained  unbiased,  exhibits  much  larger  fluctuations  (peaks 
as  high  as  0.7  pixels).  In  addition,  the  y  channel  position 
estimate  displays  a  smaller  bias  of  about  -0.4  pixels,  but 
with  a  larger  standard  deviation  equal  to  0.37  pixels.  As 
in  the  previous  case,  the  filter  modelled  the  three  spot 
image  as  a  single  spot  image  with  an  estimated  maximum 
intensity  estimate  that  was  twice  as  large  as  the  true  value 
of  any  of  the  actual  spots  present.  In  addition,  the  size 
of  the  filter  produced  image  was  large  enough  to  encompass 
the  entire  three  spot  image  shown  in  Figure  18.  In  both 


cases  the  estimate  appeared  to  oscillate  back  and  forth  (in 
the  X  direction)  between  a  pair  of  spots  while  remaining 
more  or  less  equidistant  from  the  third  (thus  the  bias  in 
the  y  channel).  In  regard  to  the  10  Monte  Carlo  simulations 
conducted  for  each  run,  such  motion  can  range  from  being 
totally  "in  phase"  to  being  totally  "out  of  phase."  That 
is,  when  "in  phase,"  the  simulations  follow  the  same  error 
sequences  in  regard  to  sign  of  the  errors.  Thus,  it  appears 
as  though  more  of  the  simulations  of  the  second  run  are  "in 
phase"  than  in  the  first  case.  Other  than  the  maneuver 
indicator  being  enabled,  the  parameters  of  these  runs  were 
identical.  Therefore,  such  behavior  must  have  been  caused 
by  activation  of  the  maneuver  indicator,  possibly  during  the 
acquisition  stage  of  the  simulations.  In  any  event,  serious 
degradation  in  filter  tracking  performance  results  when  the 
target  image  does  not  resemble  the  single  hot-spot  image 
that  the  filter  expects  to  see. 

The  performance  of  the  Gauss-Markov  filter  in  this 
scenario  (case  5  of  Table  D.1)  is  Indicated  by  the 
performance  plots  in  Figures  D-37  through  D-46  and  the 
statistical  "esults  given  by  the  third  set  of  entries  in 
Table  6.4.  There  exists  a  bias  of  -0.29  pixels  in  the  Xq 
dynamics  estimate  as  well  as  sizeable  standard  deviations  in 
both  channels.  As  a  result,  the  RMS  tracking  errors  are 
consistently  outside  the  envelope  formed  by  the  filter's 
estimate  of  its  own  errors.  The  major  contribution  to  these 
large  RMS  errors  are  the  standard  deviations  associated  with 
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the  errors.  The  large  standard  deviations  are  in  turn 
related  to  the  fact  that,  in  this  particular  case,  the 
filter  was  not  given  a  model  of  the  spatial  correlations  in 
the  measurement  noise.  As  indicated  earlier,  failure  to 
model  such  correlations  by  the  GM  and  CTR  algorithms  can 
increase  the  standard  deviations  of  the  error  by  as  much  as 
100%. 

In  contrast,  the  constant  turn-rate  filter,  in  a  case 
where  spatial  correlatins  were  modelled,  showed 
significantly  improved  performance  over  all  the  previous 
cases  discussed  involving  the  three  hot-spot  image  (see  the 
last  set  of  entries  in  Table  6.4).  This  run  is  represented 
as  case  13  with  plotted  results  appearing  in  Figures  E-17 
through  E-22.  Although  the  RMS  tracking  errors  remain  at  or 
within  the  filter  sigma  envelopes  of  both  channels,  the 
standard  deviations  are  larger  than  typical  values  for  this 
filter.  This  is  so  because  of  increased  difficulty  in 
detecting  small  translations  of  an  image  that  is  as  broad 
with  shallow  variations  such  as  in  this  particular  image. 


6.4  £er.fflrmange  ^  Chansing  Tarsfifc  Dynamics 

In  this  section,  the  results  corresponding  to  filter 
performances  during  changes  in  target  dynamics  such  as 
constant  G  and  constant  roll-rate  maneuvers  are  presented. 
Trajectories  2  and  4  of  Table  5.1  are  used  to  describe  the 
constant  G  maneuvers  while  Trajectory  1  is  used  to 
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xj.lustrate  constant  roll-rate  maneuvers.  In  each  case, 
except  for  the  Brownian  Motion  filter  developed  by  Harnly 
and  Jensen,  the  dynamic  form  of  the  multiple  hot-spot  image 
was  implemented  so  that  the  three  spots  varied  in  size, 
shape,  and  orientation  with  respect  to  each  other  on  the 
image  plane.  The  reference  size  of  this  image  is  set  by  the 
parameters  described  in  section  5.4  and  is  displayed  in 
Figure  19.  In  the  cases  with  the  BM  filter,  a  single  spot 
static  image  was  Implemented  since  it  experiences  too  much 
difficulty  in  tracking  multiple  spot  images. 

6.4.1  Constant  G  Maneuver  Performances.  Table  6.5 
displays  the  statistical  results  of  the  performances  of  the 
filters  during  the  last  two  seconds  of  each  engagement  after 
transients  had  died  out.  The  first  set  of  entries  in  the 
table  correspond  to  Harnly  and  Jensen's  BM  filter 
performance  against  a  2G  pull-up  (in  the  manner  indicated  by 
Trajectory  2)  initiated  at  a  time  of  two  seconds  after 
simulation  initiation.  The  figures  containing  the  plots  of 
this  performance  are  Figures  F-25  through  F-32.  Although 
there  is  approximately  a  1  pixel/sec  bias  throughout  the  x 
velocity  estimate  and  a  -1.5  pixel/sec  bias  in  the  y  channel 
velocity  after  the  start  of  the  maneuver,  the  overall 
performance  is  very  good.  The  position  estimates  are 
essentially  unbiased  both  before  and  after  the  manuever 
Initiation  (neglecting  transients)  with  standard  deviations 
on  the  order  of  0.2  pixels.  However,  it  should  be  noted 
that  this  author  had  some  difficulty  in  obtaining  a  run  with 
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10  out  of  10  successful  tracking  simulations  of  the  2G 
maneuver.  Loss  of  track  ocurred  as  much  as  40  percent  of 
the  time  during  this  maneuver  due  to  sensitivity  to  the 
specific  sequence  of  simulated  noise  values  as  mentioned 
earlier.  Changing  the  seed  of  the  pseudorandom  code  used  to 
generate  the  noise  values  enabled  the  performance  Indicated 
in  these  plots;  however,  there  is  still  a  non-negligable 
probability  of  loss  of  track.  This  probability  increases 
with  the  degree  of  dynamics  involved  in  the  maneuver,  since 
no  trials  were  found  in  which  the  filter  maintained  track  on 
10  out  of  10  simulations  of  a  5G  maneuver. 

The  next  three  sets  of  entries  in  Table  6.5  describe 
the  results  of  the  first  order  Gauss-Markov  and  the  constant 
turn-rate  filters*  performances  against  the  same  2G 
maneuver.  Although  the  mean  errors  are  markedly  larger  than 
those  of  the  BM  filter,  it  should  be  kept  in  mind  that  these 


filters  are  tracking  a  much  more  complex  target  image  that 
is  coming  out  of  a  roll  maneuver  prior  to  the  2G  pull-up 
(the  results  of  the  BM  filter  in  this  table  correspond  to  a 
static  single  spot  image).  The  plots  corresponding  to  the 
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Table  6.5  Constant  G  Maneuver  Performances 


X  Dynamics  Position 

y  Dynamics  Position 

Filter 
Model 
(Trajec¬ 
tory  3) 

Case 

Peak 

Mean 

Error 

Time 

Avg 

Mean 

Error 

Time 
Avg 
Stand . 
Dev . 

Peak 

Mean 

Error 

Time 

Avg 

Mean 

Error 

Time 

Avg 

Stand. 

Dev. 

BM  2G 

aj52=300 

Single 

Spot 

0.15 

0.05 

0.17 

0.30 

0.01 

0.20 

GM  2G 

9 

0.378 

0.184 

0.148 

-0.379 

-0.247 

0.163 

01)2=300 

CTR  2G 

20 

0.440 

0.369 

0.156 

-0.075 

-0.007 

0.y93 

0  1)2=300 

CTR  2G 

21 

0.403 

0.325 

0.159 

0.079 

0.002 

0.094 

atj)2s600 

CTR  2G 

22 

0.313 

0.226 

0.139 

-0.604 

-0.495 

0.376 

Ojj2  =  l000 

CTR  2G 

23 

0.435 

0.334 

0.168 

0.183 

0.063 

0.133 

Op2s5000 

(Trajectory  4) 

Bm  5G 

Ojj2-600 

Single 

Spot 

0.20 

0.10 

0.20 

0.15 

0.00 

0.18 

GM  5G 

10 

0.31 

0.174 

0.132 

-0.114 

0.005 

0.123 

Oj,2s600 

CTR  5G 

24 

0.274 

0.207 

0.136 

-0.127 

-0.016 

0.124 

GM  2G  entry  are  shown  in  Figure  D-77  through  D-92. 
Similarly,  the  plots  of  the  CTR  filter  are  shown  in  Figures 
E-91  through  E-96  and  Figures  E-97  through  E-104.  The 
results  indicate  more  difficulty  in  tracking  the  x  channel 
even  though  the  maneuver  is  mainly  in  the  y  direction.  This 
is  so  because  of  the  particular  image  described  in  this 
simulation.  The  target  is  oriented  such  that  the  image  is 
very  smooth  and  broad  in  the  x  direction.  That  is,  the 
intensity  of  the  image  only  drops  to  the  one-sigma  values  at 
the  edges  of  the  FOV  in  regard  to  the  x  direction.  Thus  the 
residual  information  due  to  shifts  in  the  x  direction  is 
much  less  significant  than  that  obtained  by  equivalent 
shifts  in  the  y  direction.  In  addition,  the  maximum 
derivatives  of  the  intensity  profile  with  respect  to  the  x 
direction  are  also  smaller,  resulting  in  correspondingly 
lower  entries  in  the  linearized  intensity  function  matrix. 
These  results  Indicate  that  the  CTR  and  GM  filters  perform 
essentially  the  same  with  respect  to  the  x  position 
estimate;  however,  there  is  significant  improvement  in  the  y 
position  estimate  of  the  CTR  filter  after  transients  from 
maneuver  initiation  have  died  out.  This  performance  is  also 
Indicated  by  the  cases  that  use  a  5G  manuever  rather  than  a 
2G  within  Trajectory  2.  The  GM  filter  never  maintained 
track  on  this  maneuver  while  the  CTR  filter  required  a 
dynamics  driving  noise  variance  of  5000  to  achieve 
satisfactory  performance  in  the  y  direction  (see  Table  6.5). 
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In  contrast  to  Trajectory  2  constant  G  maneuvers  were 
also  conducted  in  a  horizontal  inertial  plane  as  described 
by  Trajectory  4.  This  type  of  maneuver  has  much  less  effect 
on  target  image  dynamics  in  the  y  channel.  The  results  of 
the  last  three  sets  of  entries  of  Table  6.5  indicate  this 
for  the  case  of  a  5G  turn  being  conducted,  with  a  variance 
of  600  for  the  dynamics  driving  noise.  The  corresponding 
plots  are  shown  in  Figures  F-33  through  F-40  for  the  BM 
filter,  Figures  D-93  through  D-104  for  the  GM  filter,  and  E- 
120  through  E-135  for  the  CTR  filter.  The  CTR  filter  no 
longer  outperforms  the  GM  filter  since  the  image 
acceleration  on  longer  resembles  a  constant  turn-rate 
process. 

6.4.2  Constant  Roll-Rate  Maneuvers.  The  most  drastic 
variations  of  a  target  image  occur  when  the  target  undergoes 
a  rolling  maneuver.  In  the  case  of  a  multiple  hot-spot 
image  such  rapid  variations  can  cause  large  errors  in  the 
filter  produced  reference  image.  In  order  to  maintain  more 
accurate  shapes,  more  weight  must  be  put  on  the  current 
measurement  frame  when  smoothing  is  accomplished  in  the  data 
processing  portion  of  the  filter  that  is  used  to  obtain  the 
nonlinear  Intensity  function,  li[jL(t),t].  However,  an 
increase  in  the  smoothing  constant,  as  defined  in  Eq  (2-5), 
also  creates  greater  errors  in  the  nonlinear  Intensity 
function  due  to  the  additional  effects  of 
background/measurement  noise.  Thus  a  tradeoff  analysis  of 
the  two  effects  is  required. 


Table  6.6 


Performance  vs  Constant  Roll-Rate  Maneuvers 


Filter 

Roll 

Rate 

X{)  Channel 

yo 

Channel 

Model 

(Rev/ 

Sec) 

Peak 

Mean 

Error 

Time 

Avg 

Mean 

Error 

Time 
Avg 
Stand. 
Dev . 

Peak 

Mean 

Error 

Time 

Avg 

Mean 

Error 

Time 

Avg 

Stand 

Dev. 

mm 

0.5 

0.272 

0.227 

0.160 

-0.212 

-0.039 

0.126 

1 .0 

-0.233 

-0.042 

0.190 

-0.148 

-0.024 

0.117 

GM 
o  =  •  1 

2.0 

-0.223 

-0.002 

0.189 

-0.173 

-0.048 

0.115 

CTR 
a  r .  1 

0.5 

0.380 

0.210 

0.153 

-0.185 

-0.055 

0.126 

CTR 

<*s,1 

1.0 

0.402 

0.239 

0.167 

-0.186 

-0.071 

0.117 

CTR 
as, 2 

0.5 

0.539 

0.341 

0.151 

-0.284 

-0.100 

0.163 

CTR 
as. 2 

1 .0 

0.644 

0.377 

0.140 

-0.240 

-0.091 

0.136 

CTR 

ar.5 

D 

0.935 

0.497 

0.178 

-0.666 

-0.340 

0.197 

CTR 
os. 5 

1.0 

2.214 

1.057 

0.260 

-1.757 

-0.896 

0.295 

The  first  three  entries  of  Table  6.6  correspond  to 
cases  7,  8,  and  9  of  Table  D.1  in  which  the  GM  filter 
tracked  a  target  along  Trajectory  1  with  roll-rates  of  0.5, 
1.0  and  2.0  revolutions  per  second.  Examining  either 
channel  of  the  plots  of  case  7  (shown  in  Figures  D-47 
through  D-62),  evidence  of  distinct  oscillations  in  the 
filter  mean  errors  is  present  both  before  and  after  measure¬ 
ment  updates.  These  oscillations  occur  at  a  frequency  that 
is  twice  the  roll-rate  of  the  target  since  the  target  image 
is  identical  after  every  1 80  degrees  of  revolution.  Also 
note  that  the  oscillations  in  the  x  channel  position, 
velocity,  and  acceleration  errors  diminish  in  magnitude 
until  they  vanish  by  the  end  of  the  simulation.  This  is  due 
to  the  location  of  the  target  as  it  proceeds  along  this 
trajectory.  At  the  end  of  the  simulation  the  target  is 
located  at  point  where  it  is  travelling  in  a  direction  that 
is  exactly  perpendicular  to  the  line  of  sight  from  the 
sensor.  Thus,  the  motion  of  the  image  spots  due  to  the  roll 
is  confined  entirely  to  the  y  axis.  In  contrast,  the  y 
channel  errors  oscillate  throughout  the  entire  simulation. 
As  the  target  roll-rate  is  increased  from  0.5  to  1.0  (see 
plots  in  Figures  D-63  through  D-68)  and  then  to  2.0  revolu¬ 
tions  per  second  (see  plots  in  Figures  D-69  through  0-76), 
the  oscillations  display  much  more  rapid  fluctuations  (i.e., 
as  the  roll-rate  Increases,  there  is  a  corresponding 
increase  in  the  error  fluctuation  rate).  The  statistical 
results  of  Table  6.6  indicate  that  the  corresponding  errors 


decrease  as  this  occurs.  This  "improved"  performance  is  due 
to  the  fact  that  the  errors  in  the  reference  image  are  such 
that  they  begin  to  compensate  for  each  other  in  regard  to 
the  position  translational  errors  produced. 

Since  the  CTR  filter  was  based  on  a  better  model 
overall,  it  was  used  to  test  the  effects  of  roll-rate 
variations  vs  smoothing  constant  variations.  The  results 
are  presented  as  the  last  six  sets  of  entries  of  Table  6.6, 
not  all  of  which  were  plotted.  These  statistics  indicate  a 
consistent  increase  in  all  errors  as  the  smoothing  constant 
was  increased  from  0.1  to  either  0.2  or  0.5.  This  occurred 
for  roll-rates  of  either  0.5  rev/sec  or  1.0  rev/sec. 
Although  such  trends  might  not  be  expected  at  first  glance, 
part  of  the  increases  can  be  attributed  to  the  additional 
noise  effects  as  smoothing  is  reduced  (by  Increasing  the 
smoothing  constant).  It  appears  as  though  the  remainder  of 
the  error  increases  can  be  related  to  the  previous  result, 
in  which  if  the  roll-rate  is  large  relative  to  the  smoothing 
constant,  and  the  errors  are  cyclic,  the  resulting  rapid 
fluctuations  in  the  position  errors  are  actually  reduced  in 
magnitude.  Thus  of  the  values  of  alpha  studied  in  this 
research,  0,1  yields  the  best  performance.  However,  further 
studies  should  be  done  on  this  parameter;  since  a  value  of 
0.05  might  achieve  better  performance,  especially  for  slowly 
varying  targets. 
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6.5  fimamia  Deling  Malaa  Estimation 


The  Intent  of  dynamic  driving  noise  estimation  was  to 
enable  the  filter  to  adapt  to  changes  In  target  dynamics. 
When  the  estimator  Is  allowed  to  proceed  unchecked,  and  the 

target  does  not  change  dynamics,  the  eigenvalues  of  the  QpD 
matrix  decreased  until  they  eventually  became  negative 
(especially  those  related  to  the  position  states).  Since 
such  behavior  Is  not  appropriate,  means  of  bounding  the 
matrix  were  Investigated.  Initially,  the  diagonal  terms 
were  simply  Increased  to  values  of  0.1  and  the  corresponding 
row  and  column  set  to  zero  If  that  particular  diagonal 
element  had  decreased  below  zero  as  the  result  of  the 
estimation  process  described  in  section  4.7.  This  resulted 
In  performance  that  failed  to  show  significant  improvement 
even  in  tracking  benign  trajectories > such  as  Trajectory  1  of 
Table  5.1  (due  to  the  dominance  of  flT  £-1  term  in  the 
inverse  covariance  update).  Instead,  the  filter  lost  track 
when  a  2G  maneuver  was  initiated  since  even  the  eigenvalues 
of  the  Qpp  matrix  corresponding  to  velocity  and  acceleration 
decreased  to  the  0.1  lower  bound.  As  a  result 
correspondingly  larger  values  were  chosen  for  the  lower 
bounds  of  the  diagonal  terms  related  to  the  velocity  and 
acceleration  (the  values  chosen  were  equivalent  to  those 
obtained  on  the  diagonal  for  a  constant  Qpj}  matrix  with 
dynamics  driving  noise  strength  of  160).  When  the  estimated 
values  of  the  diagonal  terms  decreased  below  these  values, 
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the  corresponding  row  and  column  were  scaled  upward  while 
maintaining  the  same  correlation  coefficients  (i.e.,  each 
term  in  a  row  and  column  to  be  scaled  is  multiplied  by  the 
square  root  of  the  ratio  of  the  desired  lower  bound  to  the 
estimated  diagonal  term).  Such  a  bounding  scheme  enabled 
the  filter  to  maintain  track  through  the  onset  of  2G  and  5G 
maneuvers.  However,  before  the  simulations  were  complete, 
negative  eigenvalues  developed  in  both  the  £+  and  £“ 
matrices.  The  diagonal  terms  of  these  matricies  were  then 
bounded  to  0.01,  1.0,  and  10.0  for  the  diagonal  terms 
related  to  position,  velocity,  and  acceleration 
respectively.  This  enabled  the  filter  to  maintain  track 
throughout  2G  maneuvers.  However,  little  benefit  was 
obtained  for  all  the  extra  computation  involved.  In  fact,  a 
case  equivalent  to  case  20  (in  regard  to  filter  parameters), 
the  estimator  actually  Increased  the  mean  position  errors  by 
about  0.05  to  0.1  pixels  in  both  channels.  In  general, 
however,  position  estimates  were  not  affected  substantially 
due  to  the  dominance  of  the  fiT  £-‘1  H  term  in  the  covariance 
update  equations. 


The  conclusions  discussed  in  this  section  are  directly 
related  to  the  results  presented  in  Chapter  VI.  In 
general,  the  characteristics  of  the  target  image  being 
tracked,  in  addition  to  the  algorithms  used  to  generate  a 
reference  profile  of  this  image,  have  a  significant  effect 
on  filter  tracking  performance.  This  is  true  even  in  benign 
trajectories. 

As  a  basis  for  comparison,  the  Gauss-Markov  and 
constant  turn-rate  filters  developed  in  this  research  were 
contrasted  with  the  previously  developed  Brownian  Notion 
filter  (Ref:  5).  The  Gauss-Markov  and  constant  turn-rate 
filters,  which  used  the  data  processing  algorithm  of 
Figure  1  (i.e.,  no  a  priori  information  is  assumed  about  the 
image  intensity  distribution),  reliably  generated  reference 
Intensity  profiles  that  corresponded  well  with  true 
profiles.  This  performance  was  evident  even  when  the 
algorithm  was  confronted  by  a  dynamic  image  that  corresponds 
to  realistic  projections  of  a  "multiple  hot-spot"  target 
onto  the  FLIR  image  plane.  In  contrast,  the  Brownian  Motion 
filter  assumed  a  priori  knowledge  of  the  analytic  form  of 
these  intensity  functions. 

When  the  Brownian  Notion  filter  is  faced  with  multiple 
hot-spot  Images  such  that  its  Intensity  model  is  no  longer 


accurate,  performance  is  seriously  degraded.  In  contrast, 
the  Gauss-Markov  and  constant  turn-rate  filters  displayed 
good  tracking  performance  even  when  faced  with  drastic  image 
variations  Inherent  in  constant  G  and  constant  roll-rate 
maneuvers.  Thus  the  need  for  pattern  recognition 
techniques,  such  as  those  used  in  this  research,  is 
apparent. 

The  constant  turn-rate  filter  significantly 
outperformed  the  Gauss-Markov  filter  in  regard  to  errors  in 
both  directions  on  the  FLIR  image  plane.  This  is  to  be 
expected  since  the  dynamics  model  used  in  the  constant  turn- 
rate  model  is  a  much  truer  representation  of  typical  target 
accelerations  as  projected  onto  the  FLIR  image  plane.  When 
the  target  dynamics  are  no  more  representative  of  a  constant 
turn-rate  process  than  a  first  order  Gauss-Markov  process, 
the  two  filters  performed  equivalently.  However,  biases  on 
the  order  of  0.1  pixels  appeared  in  many  of  the  simulations 
for  both  filters.  Such  biases  can  be  attributed  to 
inaccuracies  in  the  phase  information  used  within  the  data 
processing  algorithm  and/or  unmodelled  dynamics  of  the 
target  in  the  inertial  reference  frame.  The  latter  involves 
unmodelled  motion  along  the  range  unit  vector  as  well  as 
size  and  shape  effects  when  a  dynamic  image  is  Involved. 

Along  this  line,  tracking  performance  is  somewhat 
sensitive  to  tu *  smoothing  constant  and  the  rate  of  image 
variations  during  maneuvers  such  as  constant  roll-rates. 
Such  maneuvers  cause  error  oscillations  (at  a  frequency  of 


twice  the  target  roll-rate)  when  image  symmetry  is  disrupted 
by  portions  of  the  target  being  obscured.  Increasing  the 
value  of  the  smoothing  constant  above  0.1  does  not  benefit 
performance  due  to  additional  noise  effects.  That  is,  when 
the  smoothing  constant  is  increased,  more  weight  is  put  on 
the  current  measurement  received;  thus,  the  reference  image 
becomes  more  susceptible  to  errors  due  to  the  addition  of 
background/measurement  noise. 

The  Gauss-Markov  and  constant  turn-rate  filters  were 
z'ound  to  be  less  robust  in  regard  to  spatial  correlations 
in  the  background  noise  than  the  Brownian  Motion  filter. 
Thus,  in  scenarios  where  these  correlations  vary  or  are 
mismodelled,  the  Gauss-Markov  and  constant  turn-rate  filters 
should  experience  nonnegligible  errors  even  in  high  signal 
to  noise  environments.  An  additional  effect  of  modelling 
spatial  correlations  by  the  filter  is  the  dominance  of  the 
term  in  the  inverse  covariance  update  equations. 
This  requires  that  tuning  of  the  filter  position  states  be 
done  by  changing  the  variance  of  the  filter  assumed 
measurement  noise,  05^  »  rather  than  that  of  the  dynamics 
driving  noise,  ^ 

7.2  Bfififlmasndatlflna 

Further  study  is  recommended  in  order  to  extend  the 
research  accomplished  in  this  effort  as  well  as  to  refine 
some  of  the  tracking  performances  displayed  by  the  first 
order  Gauss-Markov  and  constant  turn-rate  extended  Kalman 


filters.  Specifically,  items  of  further  research  should 
include,  but  are  not  limited  to,  the  following: 


*  Perform  additional  filter  tuning  by  varying 

the  variance  of  the  background  noise,  in  order  to 
determine  whether  bias  errors  can  be  reduced. 
Also  consider  various  truth  model  values  of  this 
parameter  in  order  to  create  different  signal  to 
noise  ratio  environments. 

*  Include  estimates  of  range/range -rate  parameters 
in  the  dynamics  models  in  order  to  account  for 
bias  errors  caused  by  the  unmodelled  motion  in  the 
inertial  reference  frame. 

<?: 

*  Examine  the  performance  with  smoothing  constants 
less  than  0.1,  especially  for  slowly  varying 
target  Images. 

*  Investigate  Implementation  of  optical  techniques 
for  processing  the  measurement  data  in  portions  of 
the  algorithm  displayed  in  Figure  1. 

*  Consider  adaptive  expansion  of  the  field  of  view 
to  maintain  track  on  harshly  maneuvering  targets 
at  close  ranges. 

*  Determine  the  effects  of  radiation  emitted  from 
the  target  due  to  the  incidence  of  the  high  energy 
laser  beam. 
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*  Comparison  of  the  algorithms  studied  In  this 
research  with  an  enhanced  correlator/linear  Kalman 
filter  tracker  on  the  basis  of  performance  and 
computational  loading  in  order  to  determine  which 
is  better  suited  for  practical  implementation. 

*  Examine  the  "crossover"  effects  introduced  as  the 
target  flies  by  at  minimum  range  and  maximum 
angular  rates.  Implement  trajectories  that  go 
past  this  point  in  order  to  observe  filter 
recovery . 

*  Determine  robustness  to  real  world  environments 
that  differ  strongly  from  the  filter  design 
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Appendix  A 

Truth  Model  QtD  Matrix  Derivation 


This  appendix  is  concerned  with  the  derivation  of  the 
non-zero  elements  of  the  dynamic  driving  noise  matrix  of  the 
truth  model.  As  defined  in  Chapter  III,  is  given  by 
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in  which  ^  given  by  Eq  (3-9),  represent  the  state 
transition  matricies  for  the  atmospheric  effects  on  target 
position  on  the  FLIR  image  plane  in  the  x  and  y  directions 
respectively . 

Thus 


^i+1 

=  J  I(ti+i,T)dT 

ti 


(A-2) 


where  £  is  an  8x8  symmetric  block  diagonal  matrix.  Each 
nonzero  element  of  £  is  a  function  of  (ti^.i  “"^ )  such  that 
^^^i+1»‘')  =  ^^^1  +  1  -t).  Making  the  substitutions 
u  r  ti^i  -  and  du  s  -dr,  the  old  limits  of  Integration, 

ti^i  ,  become  the  new  limits,  &t  0,  when  the  sampling 
time  is  held  constant.  As  a  result,  Eq  (A-2}  becomes 
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The  equivalence  of  the  two  nonzero  blocks  In  Eq  (A-4)  is  due 
to  the  independence  of  the  model  in  the  FLIR  x  and  y 
directions.  Each  of  the  six  different  nonzero  elements  in 
represents  a  single  component  of  the  matrix  integral  in 
Eq  (A-3)<  The  exact  results  are  as  follows: 
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where  A,B  are  the  break  frequencies  of  the  shaping  filter 
atmospherics  model  and, 


G1 


KAB2 

(A-B) 


G2  =  -G1 


G3  =  (A-B)G1 

which  are  the  appropriate  values  for  representation  of  the 
truth  model  atmospherics  in  the  Jordan  canonical  state  space 
form  (Ref;  12). 


Appendix  B 

Derivation  of  the  Constant  Turn-rate  Filter's 
E  and  Ip  Matrices 

The  derivation  of  the  linearized  £  matrix  for  the  CTR 
filter  is  not  as  simple  as  it  was  for  the  first  order  Gauss- 
Markov  filter.  Since  the  dynamics  model  of  the  CTR  filter 
is  nonlinear,  the  point  of  linearization  is  dependent  on  the 
current  value  of  the  state  vector  and  cannot  be  precomputed/ 
Specifically,  Eq(B-1)  is  used  to  calculate  £. 
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The  nonlinear  function,  f[A(t),t],  is  as  defined 
previously  in  Eq(4-14).  Thus  the  £  matrix  has  the  form 
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where 
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=  correlation  time  of  the  atmospheric  jitter 

with  the  components  of  the  state  vector  written  as 

T 

Jt  =  [xi,  X2,  X3,  X4,  X5,  X6,  X7,  XB^ 

Once  the  matrix  is  determined,  the  state  transition 

matrix  can  be  evaluated  using  the  quasi-static 
approximation : 
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The  exact  closed  form  of  the  two  atmospheric  terms  can 
be  determined  easily;  however,  the  remainder  of  Eq.  (B-3)  is 
approximated  as  shown  by  Eq.  (B-4). 
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where 

A  =  At 
B  =  At2/2 


Cl  = 

AtF  ^ 

C2  =  AtF2 

C3  = 

AtF3  +  1 

C4  =  AtF4 

C5  r 

AtFg 

C6  =  AtFs 

C?  . 

AtFy 

C8  =  AtFs  +  1 
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Appendix  £ 


Generation  of  a  White  Gaussian  Noise  Process 

Since  white  Gaussian  noises  are  present  in  many  of  the 
stocastic  processes  modelled  in  this  research,  it  is  useful 
to  know  how  realizations  of  such  noises  can  be  generated. 
For  instance,  a  discrete-time  white  Gaussian  noise  process 
with  zero  mean  and  a  given  variance  can  be  obtained  through 
the  use  of  pseudorandom  codes.  Specifically,  consider  a 
psuedorandom  code  that  produces  samples  of  a  scalar  random 
variable,  that  is  uniformly  distributed  between  the 

values  zero  and  one. 

1 

0  1 

Figure  C-1 .  Uniformly  Distributed  Random  Variable 
The  mean  of  this  distribution  is  given  by 

flS 

=  f  =  1/2  (C-1) 

and  the  variance  by 

(x)dx  =  1/12 


(C-2) 


Now,  if  M  independent  calls  are  made  to  such  a  routine  to 
produce  the  realizations,  c  for  is1,M;  which  are  then 
added  together  forming, 

M 

nj  =  s  Ci  (C-3) 

the  result  represents  a  realization  of  a  new  random  variable 
with  a  mean  of  (M/2)  and  a  variance  of  (M/12).  The  Central 
Limit  Theorem  states  that  the  resulting  distribution 
approaches  a  Gaussian  as  M  grows  without  bound.  In  fact,  it 
has  been  indicated  that  a  Gaussian  approximation  becomes 
reasonable  for  an  M  greater  than  three  (Ref:  7,  p  109).  As 
a  result,  a  discrete  realization  of  a  Gaussian  distribution 
of  zero  mean  and  unity  variance  can  be  had  be  choosing  M 
equal* to  twelve  and  forming 

Ij  =  -  6  (C-n) 

where  oj  is  now  the  sum  of  twelve  independent  calls  to  the 
pseudorandom  code.  Finally,  the  realization  of  a  white, 
zero  mean,  unity  variance,  Gaussian  noise  vector  can  be 
formed  by  ordering  separate  realizations  of  the  scalar  Cj  's 
into  a  vector  of  appropriate  length. 
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This  appendix  contains  the  plotted  output  for  the  cases 
studied  that  involve  the  first  order  Gauss-Markov  filter. 
Each  plot  is  labled  with  its  corresponding  case  number 
(1-11).  The  values  of  the  parameters  used  in  each  of  these 
cases  are  listed  in  Table  D.1. 
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Table  0.1b  Parameters  Held  Constant 


Parameter 

Value 

IMAX 

20 

NF 

0 

NZ 

0 

NFRMS 

150 

NRUNS 

10 

(XO,  YO,  ZO) 

(5000,  500,  20000) 

(AXO,  AYO,  AZO) 

(0,  0,  0) 

SIGVO 

(4.0,  1.5,  1.5) 

SIGPVO 

(1.0,  1.0,  1.0) 

DELV 

(.64,  -.86,  -.86) 

DELPY 

(0.0,  2.5,  -2.5) 

TDF 

1.5 

TAF 

0.07072 
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This  appendix  contains  the  plotted  output  for  the  cases 
studied  that  involve  the  constant  turn-rate  filter.  Each 
plot  is  labled  with  its  corresponding  case  number  (12-24). 
The  values  of  the  parameters  used  in  each  of  these  cases  are 
listed  in  Table  E.1. 
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This  appendix  contains  the  plotted  output  for  the 
previously  developed  Brownian  Motion  adaptive  filter.  Each 
plot  is  labled  with  the  trajectory  or  maneuver  that  was 
performed  during  the  simulation. 
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This  appendix  contains  the  Fortran  source  code  for  the 
comuter  programs  used  in  this  study.  The  first  portion  of 
the  appendix  contains  the  complete  implementation  of  the 
algorithm  of  Figure  1  with  the  first  order  Gauss-Markov 
Filter  subroutines.  This  is  followed  by  the  corresponding 
subroutines  that  must  be  substituted  to  implement  the 
constant  turn-rate  filter.  Finally,  the  plot  routine  used 
to  generate  the  plots  for  this  research  is  presented.  This 
routine  is  designed  for  on-line  use  with  the  HP  plotter. 
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10 


15 


20 


33 


35 
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C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


PROGRAM  MAlNdNPUTf OUTPUT, TAPE5=INPUT*TAPE6=0UTPUTt'^APEa, 

1  0E8UG=0UTPUT» 

REAL  EV0<3},£PV0(3),EPPV0(3) , EV(3> ,EPV<3) fEPPV(3) ,RF (2,3> 

REAL  5IGV(3} tSIGP VC 3> , SI GVOC 3 ) , SI GPVOC 3 ) , DEL V f 3 ) , OELPVC3 ) 

REAL  IHAX(3>,SC12>,XMAXf3>fYMAX(3),R(6Af6A),FIMV<6A,6A) 

REAL  LIKHC6A,6 >,NLIKH<6A) 

REAL  XT(£,l),PHIT{£,a>,BDf6,A),UTCA>,Q0Pn0T(8,8)fH(2,e)fYT(2*l 
^EAL  UC6A>,V(6A),UCC5T6> 

REAL  ICC 3,3>,RR00TC6A«6A),RFIL(6A,6A) 

REAL  UP0(£l,PUP0(8,8>*QF0MAXf8),aF0MIN{8> 

COMPLEX  SO(24,2A),SXC2A,2A>,SY(2A«24) 

INTEGER  NK<2) 

COMPLEX  OATA(2A,2A),UORK(50) ,SAVE(2Af2A),0X(2A,2AI,0YC2A,2A) 
COMPLEX  S0ATA(2A,2A) 

data  STRUCTURES  TO  GATHER  STATISTICS  ON  FILTER 
TRACKER  CAPIBILITY 

XFME  IS  THE  ERROR  BETWEEN  THE  PREDICTED  X  DYNAMIC  LOCATION 
AT  A  PARTICULAR  MINUS  TIME  AND  THE  TRUTH  MCDEL  TRUE 
X  DYNAMIC  LOCATION 
XFME2  IS  THE  SQUARE  OF  THE  XFME 

NOTE  THAT  XFME  AND  XFME2  ARE  ARRAYS  WHICH  ARE  DIMENSIONED  tq 
BE  2X150  THE  FIRST  ROW  IN  EACH  IS  USED  FOR  THE  X 
DIRECTION  WHILE  THE  SECOND  ROW  IS  FOR  THE  Y  DIREC’^IOl 

CNME  IS  THE  ERROR  IN  THE  PREDICTED  LOCATION  OF  THE  CEN-^ROID 
A  PARTICULAR  MINUS  TIME  COMPARED  TO  THE  TRUTH  MODEL 
CNME2  IS  THE  SQUARE  OF  CNME 

NOTE  AGAIN  THE  DIMENSION  CF  CNME  AND  CNHE2C 

REAL  XFME<6f 150>,XFME2C6,15C ) »CNHEC2 ,150 ) ,CNME2 « 2 ,150 ) 

XFPE  IS  THE  ERROR  BETWEEN  THE  UPDATED  DYNAMIC  LOCATION  AT  A 
PARTICULAR  PLUS  TIME  AND  THE  TRUTH  MODEL  TRUE  DYNAMIC 
XFPE2  IS  THE  SQUARE  OF  XFPE 

NOTE  THE  DIMENSIONALITY  OF  XFPE,XFPE2  FOR  THE  SAME  REASONS  AS 
ABOVE  THE  15C  ALLOWS  COMPUTATION  OF  STATISTICS  PER 
FRAME  UP  TO  150  FRAME 

CNPE  IS  THE  CENTROID  ERROR  AT  THE  PLUS  TIME 
CNPE2C 

REAL  XFPE<6,150»,XFPE2f6,15C ),CNPE(2,150 ),CNPE2«2,150 ) 
real  PDMC8,150  ),PDPCr.  ,150> 

filters  data  STRUCTURES 

PHIF  IS  THE  state  TRANSITION  MATRIX  FO»  THE  KALMAN  FILTER 
-SEE  SUBROUTINE  FILTER 

QFD  IS  THE  RESULT  OF  THE  INTEGRAL  TERM  IN  THE  PROPAGATION 
-OF  THE  COV  MATRIX  SEE  SUBROUTINE  PROPF 
PFP  IS  THE.  FILTERS  COVARIANCE  MATRIX  PLUS-  AFTER  INCORPORATI 
-OF  A  measurement 

PFF  IS  THE  FILTERS  COVARIANCE  MATRIX  MINUS  AFTER  PROPAGATION 

4A8 


1 


PSaGPAM  MAI^ 


37rS 


7A/7A  0PT=1  PPOMP 


FTN  A.E^SSA 


-BUT  PRIOR  TO  »'EASUREPEM  INCORPORA’ I CN 
XFP  IS  THE  FILTER  STATE  VECTOR  PLUS 

XFR  IS  THE  FILTER  STATE  VECTOR  MINUS 

PDIAG  IS  THE  MATRIX  THAT  WILL  PASS  DIAGONAL  ELEMENTS  OF  PFP  Al 
PFM  TO  STATFP  AND  STATFM  RESPECTIVELY 

PEAL  PHIFI8*R) *OFD(a*8>*PFP(8f3>tPFM(0*8>tXFPC8)f XFM(8)tPDIAGC8 
REAL  XFPCLD<e»#HTRR(2> 

Z  IS  THE  KALMAN  FILTER  MEASUREMENT  VECTOR 

REAL  Z(6^l 


DATA  NN/24*2^/ 

INITIALIZE  THE  FILTERS  DATA  STRUCTURES 

DATA  or/. 0333333/ 

DATA  TDF/1,5/ 


INITIALIZATION 


56C 

54321 


3751 

561 

3792 


4023 


3793 


379  5 


•*13) 


*«I3> 


CALL  RANSETC12345) 

PRIN’  *9  •  ******************* 

PRIN'  *#  •  PROGRAM  GAUSS  " 

PRINT  *,  •  #***•****•********• 

FORMAT (F6,2) 

READ(5«5fll  NZ 

IF  (E0F<5  ).NE.C }  GC  ’0  6421 

WRITE<6t3791 I  NZ 

FORMATd  Xt*rJUMBER  OF  ZEROES  TO  PAD  =  **I3) 

FCRMAT<I3 ) 

NZM.=25-f;7 

FORMAT<lXf*NUMBER  OF  FRAMES  =  **I3) 

READ<5f561)  NFRMS 
WRITE<6.3792)  NFP.MS 

F0PMAT<1X»*NUMBEP  OF  SIMULATIONS  =  **I3) 

PEAD(5t561)  NRUNS 
WRITE(6f 4C23I  NRUNS 

FORMAT<lXt*ALPHA  FOP.  SMOOTHING  =  *tF6.2> 

READ(5t56C)  ALPHA 
URITEf6f3793)  ALPHA 

FOPMAT<lXf*NUHBEH  CF  HIGH  FREQ  COMPONENTS  TO  ZERO  =  **I3) 

-EA0<bt561)  NFREO 

WFITE(6f37S5)  NFPEQ 

IGF=14-NFPE0 

IEF=12*NFRE0 

FORMAT<lXf*lNPLT  MEASUREMENT  ERROR  VARIANCE  =  •tFG.Z) 
HEAD(5f360>  VAFM 
WRITE(6*3789)  VARM 
FORMAT  <F10. 2  ) 

CALL  INITFCTAFfVARDF,VARAFtVARYQ.VAROFC) 

DEFINE  TRUTH  MODEL  DYNAMICS 


*tF6.2> 


PR06»AH  HAIN 
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66es 

c 

c 

c 


€7f^S 


FORMATaXt*STD.  DEV  OF  truTH  M3DEL  ATMOSPHERIC  JITTER*#F5*3) 
PEA0(5«6666)  SIGAT 
WRITEf6,^6S»  SIGAT 
FORMAT <F5-3) 

READ  IN  INITIAL  CONDITIONS  FOR  THE  VEHICLE  POSITION  AND  VELOCIT 

DO  6Q0  I=l«3 
DO  6C0  J=lt3 
°EAO(5t5£>2)  IC(IfJ) 

RF(1 tJ)=FLCAT( J) 

oF<2*J)=C- 

CONTINUE 

URITE(6«€789}  ( { ICC  I « J> • J=1 « 3) 1 1 =1 1 3 > 

FORMATClXt*INERTI  AL  POSI TI  ON*  t /*  5X  **XO=  *  tFl  0 .2  t5X,*  YO=  *tFl[}.2 
n  t*ZC=  *#F10*2#//**  INERTIAL  VELOCITY*, 7f2X,*X00T0=  *,F10.2 

H  *YOCTO=  *,F10«2,2X,*ZDOTO=  *  ,F10  .2  ,//,*!  NERTI  AL  ACCELERA'^IC 
n  /,*AXO=  *,F10.2,5X,*AYO=  *,F10.2  ,5X,*  AZO=:  *,F10.2*/) 


SET  UP  THE  DESCRIPTION  OF  THE  TARGET  AND  ITS  TRAJECTORY 

CALL  0ESCRIB(IMAX,XMAX,YMAX,SI6V0,SI6PV0,0ELV,DELPV, 
n  S,REVRT,TO,Tl,NG,YT,ITARG) 


INITIALIZE  TRUTH  MODEL  MATRICIES 

CALL  TRUTH(PHITfBD,UT,QDROOT,H*SIGAT,OT> 

INTIALIZE  THE  FILTERS  PARAMETERS 
INITIALIZE  THE  FILTERS  MATRICES  DEFINITION 

CALL  FILTER<TDF,VARDF,TAF , VAR AF, DT ,PH IF* QFDf OFDM AX ,QFDMI N) 
CALL  PRINT<QFDHIN*1,8,6H0FDMIN) 

CALL  PRINT(aFDMAX,l,8,6HQFDMAX ) 

CALL  PRINT (QFD*8*8*3HQFD) 


INITIALIZE  THE  FILTER  ERROR  MATRICES  TO  ZERO 

DC  2  3  J=1,NFRMS 
DO  21  1=1,2 

CNME(I,d»=CNFECI ,J»=0* 

CNREZCI, J)=CNPC2(I,J)=0. 

DO  22  1=1,6 

XFME<I,J»  =  XFPE<I,J>=C, 

XFPE2 (I, J)=XFFE2< l,dl=0« 

DC  23  1=1,8 
POMCI,J)=PDP<I ,J)=0. 

SET  UP  IDEAL  DATA  FCR  ERROR  CALCULATION 


PROGRAM  MAIN  74/74  CPT=1  PMDMP  F'^N  4«8*564 


C  CALL  IDCAL(IMAXtSfXMAX«YHAXf24fr.ZtXtytS0fSX«SYfRFtKS) 

C 

C  USINGFIP.ST  AND  SECOND  NEAREST  NEIGHBOR  DETERMINE  THE  CHOLESKY 
C  SQUARERCOT*  R»  OF  THE  MEASUREMENT  COVARIANCE  MATRIX*  R 
C 

CALL  SPTNCVARM  *P  *8  > 

C 

C  THIS  LOOP  MAKES  SPATIALLY  CORRELATED/UNCORRELATED  NOISE 

C  COMMENT  THE  NEXT  FOUR  LINES  IF  WANT  SPATIAL  CORRELATION 

PRIf,T  *,  -PFIL  =  2.*R" 

0^  6428  1=1*64 
00  6428  J=l«64 
RFIL<I*J1=2.*F<I*J> 

C  IF  CI.NE.J}  FFIL<I*J>=C. 

C  PINVn*J)=C. 

C  IF  (I.EQ.J)  RINV(I*J)=1./i;FIL(I*J) 

6428  CONTINUE 

PRIN’  **  "DIAGONAL  RFIL" 

C 

C  COMPUTE  RROOT  -  THE  CHCLESKY  SORT  OF  « 

C 

CALL  CHCLYCR»64*RP.0C7> 

C 

_  C  GET  THE  INVERSE  OF  THE  SPATIALLY  CORRELATED  MEAS  NOISE  COV 

(•7  C  matrix  USED  IN  THE  FILTER  MODEL 

C  -  NEEDED  FOR  THE  INVERSE  COV  METHOD 

C 

CALL  INVERTCRFIL*64*RINV> 

C 

C** •••••*••*••«**«•**•*••**********•••**••* •*******«*«***•********•* 
C**  END  INITIALIZATION  ** 

€*«**•«••••*****•*****•**•**••*»****•***•****•***•**••*•*•*•••**•*** 

C 

c***** ******************* ******************************************* 
C**  BEGIN  MONTECARLC  SIMULATION  " 

C*« ******* «***•••*•****•*«****«*«*****••*••******«« **•*•***•*•*•«*** 

C 

C  MAKE  NPUNS  SIMLLATICNS  OF  NFPMS  EACH  FOR  MONTE-CARLO  ANALYSIS 

C 

FORMAT  (1X**RUN  NUMBER  **13*/) 

DO  9C  NS=1*NRUNS 
URITE<6*91»  NS 
C 

X3HIFT=C . 

YSHIFT=0. 

HTRP(1)  =  H'^RRC2)=0. 

C 

C  ZERO  OUT  IDEAL  AND  ACTUAL  DATA  DERIVATIVE  ARRAYS 

C  INITIALIZE  SMOOTHED  DATA  ARRAY 

c 

D^  7  1=1*24 
DO  7  J=l*24 
DX(I*J)=CMPLX(0.*0.> 

OYfI*J)=CMPLX(0.«0*) 

7  SDATACI* J)=CMPLXf 0.*0.l 
C 
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C  INITIALIZE  STATE  VECTOR 

C 

DO  71  1=1*8 
71  XT(I*1)=0. 

XT(1  tl)=3.0 
XT(2*1I  =  3.0 
YTCl  .1»=3.0 
YT<2*1)=3.0 
C 

C  INITIAL  CONDITIONS  FOR  THE  FILTER 

C 

DC  106  I=l#e 
UPD<I)=C .0 
DC  106  J=lte 
PFM<Tt J)=C«C 
PFP<I*J)=0.0 
PUPD(I*J}=0.C 
xFP<r 1=0 .0 
106  XFP(II=0.0 

PFP(1*1)=.2 
FFP<2*2)=.2 
PFP(3*3)=16. 

PFP(A*4>=16. 

PFP(5*5)=20C- 

PFP(6*6)=2CC. 

PFP<7*7)=.2 

PFPC8*8)=«2 

C 

TRXXT  =  20- 
C 

FH0R0=SQRT<IC<1*1I*»2*ICC1*3)»*2) 

C 

C  GET  INITIAL  CONDITIONS  ON  DYNAMIC  STATES 
C 

CALL  COMPUTE ( XI «YI *21 •VX*VY*VZ*RAN6E*UT*0 vTl •IC*NG*NS> 
C 
C 

XFP(1>=3.0 

XFP<2)=3-0 

XFP<3)=UT(1) 

XFP<4>=UT<2) 

XFP(5)=UT(3> 

XFP(6»=UT<4) 

C 

DC  3C  1=1*6 
XFM(II=XFP(I ) 

3C  CONTINUE 

C 

c 

C  DEFINE  UPPER-LEFT  CORNER  OF  FOV 

C 

X=XFP<l)-4. 

Y=XFP<2)-4. 

C 

C 

C  TRACK  TARGET  FOR  NFRAME  FRAMES  CTIME  SLICES) 


PROGF  AM  PAIK 


74/74  OPT=l  PMDPP 


FTK  4*e<t>fe64 


C 

IF  (NS.EQ.l)  CALL  PPINKXFPfl  1 9  *1 OHINIT  STATE! 

C 

DO  90  NR=1*MFRMS 
C 

C  LOCATE  XHAXt  YMAX*  AND  DETERMINE  S  AND  RF  fRAAGE  FLAG)  MATRICIE 

C  GHEN  DYNAMIC  IMAGE  IS  DESIRED 

C 

IF  (ITARG.NE.l)  GO  TO  3? 

CALL  L0CATE(XMAXtYKAX«SI6V«SI6PV«YTtUTtS«PANGE«XI«YI«ZIf 
ff  VXvVYvVZtNRyTCtTl «REVRTf DELVtDELPVtSIGVOvSIGPVOtNGf 

«  EVO  «EPVCtEVtEPVtRF«NS> 

C 

C 

39  CONTINUE 

C 

c 

C  GET  MEASUREMENT  NOISE  ARRAY 

C 

CALL  N0ISECW*£.4> 

CALL  MULT(RRC0T«Wt64,64tl»V) 

C 

C  GET  MEASUREMENT  DATA 

C 

C 

C  IF  (ITAR6.E0.2) 

C  A  CALL  SINGLE(IMAX«StYTfi*l>«YT(2tl  )»XFH(1)  tXFMC2>fDATA«DXtOYtNRf| 
C  IF  CITARG.NE.Z) 

CALL  INPUT3f IMAXtStXMAXtYMAX«24*NZ«X9Y«DATAfCENXfCENYtRF»NR»NS> 
C 

C  CALL  lOEALCIMAXf StXMAXvYMAXtZAvNZfXfYtDATAvDXvCYyRFtITARGtNRtNS 

C  A''0  CORRELATED  MEASUREMENT  NOISE  TO  CENTER  8X8  PIXEL  DATA 

I 

C 

DC  4  1=1 f8 
DO  4  J=l,8 

DATA<I+8  » J^e )=DATACI  +  8fJ*B )♦CMPLX( VCR  * (I-l I^J) tO.O ) 

4  CONTINUE 

C 

C  ADD  UNCCRRELATED  NOISE  TO  MEASUREMENT  DATA  OUTSIDE  CENTER 

C  8X6  PIXEL  AREA. 

C 

CALL  N0ISECUCt576  ) 

DC  6  1=1 t24 
DC  6  J=l924 

IFf I.GC.9.AN0.I.LE.1G.A\D.J.GE.9.AND. J.LE.16)  GC  TO  6 
IF(CI.LE.NZ) .OR.C J.LE.NZ).OR.f I.GE.NZMI.OR.C J.GE.NZM))  GO  TO  6 
DATACIf  J)=DATA(I  t  J)-»CMPLVfUCf  24*(I-1  ><»J >  tO  •  )  *SQRT  (  V AR  M). 

6  CONTINUE 

C 

C 

C  CREATE  THE  MEASUREMENT  VECTOR  FOR  THE  FILTER  UPDATE 

C 

KrO 

DO  101  1=9916 
DO  101  J=99l6 
K=K^1 

ZfK)=REALfDATAfI 9 J)) 

,.453, 


40 
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C 

C  LOUER  BOUND  MEASUREMENT 

C 

IF  <Z<K}.LT«0«>  Z(K)=0. 

Z<K)=Z(K)*0«1 
ICl  CONTINUE 
C 

C  SAVE  DIAGONAL  ELEMENTS  OF  PFM  FOR  FILTER  SIGMA  PLOTS 
DO  111  i=i*e 
111  PDIAGf I>=PFM<I«II 
C 

C  GO  CALCULATE  THE  ERRORS  OF  THE  FILTERS  ESTIMATE  PRIOR  TO 
C  MEASUREMENT  INCORPORATION 

CALL  STATFH(XFMEtXFME2*CNME*CNME2*XFH#XTtVT#UT*NPfNFRMSt 
»  POIAGtPDM) 

C 

C 

IF(NP.EQ.l)  GO  TO  164 
MANIf.D=n 

c 

C  SHIFT  TO  SAVE  COPY  CF  OLD  XFP 

C 

DC  4G0  I=lt8 
400  XFPOLDd  IsXFPCl) 

C 

C  INCORPORATE  MEASUREMENT 

C 

2CC  CALL  UPDAT<Z*LINH*NLINHtXFP#XFMtPFP*PFM#UPO#PINV*NSeNR*HTRR» 
C  DETERMINE  TRXXT  AND  APPROPRIATE  QFD 

C 

trxxto=trxxt 

CALL  QADAPT<NRtTRXXT*UPO*PUPDtOFD*QFDMINtQFDMAXtPFPt 
tt  VAROFOtTDF«VARAFtTAFtVARYQtNS> 

C 

C 

GO  TO  30  0 
C 

c 

C  FOLLOWING  STATEMENT  PREVENTS  RE-PROCESSING  ESTIMATE  TWICE 

C 

IF  (KANIND.EQ.l)  GO  TO  300 
IF  CTRXXT.lt. 5. *TRXXTO)  GO  TO  300 
C 

C  SET  MANEUVER  INDICATOR 

C 

MANIND^l 

PRINT  **  •ES'^IMATE  REPROCESSED" 

C 

C  LOWER  BOUND  PFP  DUPING  MANEUVER 

C 

C  THIS  PROCESS  MAINTAINS  THE  SAME  CORRELATION  CCEFFICIEN'TS 

C 

DC  233  1=3*4 

VFACT0R=10./S0FT(PFP<I*I>) 

AFACTOR=3  00./SQRT<PFPCI^2*I»2  )) 

DC  232  J=l*8 

IF  <PFPCI*I).LT.100.>PFPCI*J)=PFP(I.J)*VFACT0R 


i 
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FTN  4.6-»564 


^00 

■ 


ki'os 


10 


3 

1 


►/ 

•w' 


?;50 


-■45 


«S5 


232 

233 
C 

C 

C 


IFCPFPd  ,I).LT.100.  )  PFPCIfJ)=PFPCIt»ll*VF ACTOR 
IF  fPFPC I*2tI*2I.LT.900CC.)  PFP < I *2 f J l=PFP C I +2 tJ 1 *AFACTOR 
IF  (PFP(I+2*I  +  2).LT •90000.)  PFPC J *!♦£  )=PFP ( J 1 1*2 ) •AFACTOR 
CONTINUE 
CONTINUE 


C 

c 

c 


REPROPOGATE  OLD  ESTIMATE  USING  INCREASED  PFP 

CALL  PRCPF<CNR-l)tNS*PHIFtQFD*PFPfPFMtXFPOLD*XFH*PUPDfMANIND) 
UPDATE  RE-PROPOGATEO  ESTIMATE 


30  C 


GO  TO  20  0 
HANI^  D=0 
DC  222  I=l«e 


i- 15 

'  • 

222 

C 

C 

FDIAG<I)  =  PFPCI*I  ) 

CALCULATE  THE  ERRORS  FOP  THE  FILTER  AFTER 

THE  INCORPORATION 

.:;20 

c 

c 

c 

OF  THE  MEASUREMENT 

CALL  STATFP<XFPE*XFPE2*CNPE#CNPE2*XT*YT*UT#XFP*NR*NFRMS* 

A  POIAGvPDP) 

COMPUTE  THE  SHIFT  INFORMATION  FROM  THE  CENTER  OF  FCV 

•  •, 

e 

c 

XSHIFT=X-XFP<1)*4.-XFPC7) 

YSHIFT=Y-XFP(2)*4.-XFP<8) 

175 

f* 

IF  (KS.EQ.l)  URITEC6*175)  XSHI FT*VSHIFT 
F0RMAT<T12**XSHIFT*  : * *F! 0 .7 *T42 * *YSHIFT* 

:**F10.7> 

30 

1 

M 

164 

C 

c 

C 

c 

CONTINUE 

SHIFT  THE  DATA  ARRAY  APPROPRI ATELT 

GET  FORWARD  FFT 

^  " 

35 

!L."i 

U 

c 

CALL  F0URT<DATA*NNt2*>l«l*U0RK) 

1F5 


IF  INS.EO.l) 

»WPITE<6tl05)NRtYT(ltl)fYTC2«l) «fUTCl)«I  =  lt4)«  CXFM(I),I  =  1,G)« 

H  CXFP(I)tI=l«6) 

FORMAT(/f T2#*FPAME:  *tI3fFX**X  POS*»lOXt*Y  POS*tlOX**X  VEL*tlOX| 
«  -Y  VEL«*9X**X  ACCEL*f8Xf»Y  ACCEL** 

A  /**  T^UTH  H0DEL:**6C1X*F14.5)* 

«  /«*  FILTER  MINUS:*t6(lX«Fl4.5} * 

A  /**  FILTER  PLUS:*f6(lX«F14.5) ) 

IF  (NS.EQ.l)  PRINT  **■  TRXXT=  "tTRXXT**  CENX=  ■* 

ACENX*«  CENY=  "tCENY 


C 

C 

C 

C 


FILTER  DESIRED  FREQUENCY  COMPONENTS  OUT 


IF(NFRE0.6T.12)  NFREQsl2 
IF(NFREQ.LE.r )  GO  TO  3796 
DC  8  i=r.F*:EF 
DC  6  J=l*24 

DATA(I*J>::CMPLX(0.*0«> 
DATA! J«I )=CMPLX<0.*0.) 


455 


u,mim  t  ■ 
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37S6 

C 

C 


CONTINUE 

ASSUME  IF  NR=1  THAT  THE  DATA  IS  CEN’ERED 
IFCNR.NE.l)  CALL  SHIFT(OAT A t 24 t XSHIFT « YSHIFT ) 

CALL  SMOOTHf DATA t SO ATA« ALPHA t24«NR) 

IF  (NR.EQ.lC.ANO.NS.EQ.l)  CALL  OISPL AY< 24 t24 «SX) 

IF  CITARG.EQ.l«AN0.NR.EQ.€fNR/5>*5)«AN0.NS.EQ.l) 

«  CALL  DISPLAYC24t24tS0ATA> 

IF  (NR.EQ.lC.ANO.NS.EQ.l)  CALL  0ISPLAY(24«24 ,DX> 

IF  (NR.EQ.lO.ANO.NS.EQ.l)  CALL  DISPLAY(24»24«SY) 

IF  CNR.EQ.lO.ANO.NS.EQ.l >  CALL  DISPLAYC24f24«0Y> 

CALL  PROPF(NR*NStPHIF#QFD*PFP*PFM#XFP#XFM*PUPDtMANIND) 


X=XFH<lJ-4* 

Y=XFM(21-4. 

XSHIFT=XFM<7I 
YSHIFT=XFM<8  » 

•» 

ROUTINE  FOR  COMPUTING  PERFECT  INTENSITY  DATA  FOP  ERROR  COMPUTAT 

DO  170  I=lf24 
DC  170  J=l#24 
SAVE<l«J>=SDATA(ItJ) 

CALL  SHIFT<SAVE*24f XSHIFTfYSHIFTI 
CALL  0ERIV(SAVEf24»0XtDY) 

CALL  F0URT(SAVEtNNt2tlflfU0RK> 

CALL  FOURT(OXfNNt2tlflfUORK> 

CALL  FOURTfOYfNNf2«ltlfUCRK) 

SCALE  THE  INVERSE  TRANSFORM  ALONG  WITH  SETTING  THE  APPROPRIATE 
SIGN  TO  INDICATE  THE  CHANGE  IN  INTENSITY  PATTERN  WITH  PESPECT  T 
CHANGE  IN  STATE 

DC  172  I=lt24 
DO  172  J=lf24 
DXCI tJ)=-DX(I«J)/57G« 

SAVECIf JlrSAVECIf J>/57G. 

DY(I tJ)=-0YCItJ>/576. 

FILL  IN  THE  LINEARIZED  INTEVSITY  ARRAY 

IF  ITARG=3  GIVE  PERFECT  KNOWLEDGE  OF  DX  AND  DY 
IF  <ITABG.EQ«2> 

»  CALL  SINGLE<IMAXfSfXSHIFTtYSHIFTtO«.O.tDATA*DX*DYfNRtNS> 


K=0 

DO  102  I=9tlG 
DO  102  J=9tl6 
K=K^1 

LINH(Kfl)=REAL<DXCIfjn 

LlNH(Kt2>=REALCOYCI«J)l 
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5679 

C 

c 


5680 

C 


5677 


LINH(K«3)=0. 

LINH(Kf4)=0. 

LINH(Kt5>=0. 

LINH(K«6)=0. 

LINH(Kt7)=LINH(Ktl > 

LINH(Kt6)=Ll  .HfKt2} 

NLir!HCK>rREAL<5A  VCfI«J)) 

IF  (NR.NC. CfNR/5)*5>«AND.fNR.LT.60.0R«NR.6T«80))  GO  TO  105 
IF  CNS.EQ.l  )  URITE<6f5679)  ( f RE AL (OX (I t J I > f 
tt  J=9tlG>  tl=9tl6) 

FORMAK*  OX  **8(T10f8F6.2*/)  » 


IF  (NS.EQ.l  )  URITE(6tS660)  ( ( RE AL (DY(I t J 1) t 
U  J=:9tl6)«I=9tl6) 

FORMAT!*  DY  • tfe < TIO *aF6 .2*/) ) 

IF  (NS.EQ.l  }  URITE(6t5677)  Z,  NLINH 
ltt((Z(l  >-NLlNH(I)  )fl=lt64) 

FORMAT!*  (T10«8F6.2«/>t/**  NLINH* *9 (T 10 t P F6.2 t/ ) • 

n/9*  Z-NLlNH*ta(ri0fPF6.2t/>> 


CALL  PR0P(PHIT  fB0tUT«Q0R00T*H«XT»YTfR«2«NR«DTtICfNGtN'St 
M  RANGEtXItYl«Zl*VXtVYtVZ»Tl ) 


PRINT  line  IhiOCATING  END  OF  PRINTED  INFO  FOR  THIS  FRAME 
IF(NS.EQ.1)PRINT  *,  • - - - 


IF(NS.EQ.1)PRINT  *,  ■  ■ 


IF  (ITARG.EQ.ll  GO  TO  90 


COMPUTE  NEU  XMAX  YMAX  POSITIONS  FOR  STATIC  IMAGE  TARGE"^  AND 
DEFINE  GAUSSIAN  PEAK  LCCATIONS  BASED  ON  CENTROID  POSITIONt  YT 


IF  (ITARG.NE.O)  GO  TO  89 
XMAX(1)=YT(1*1I 
XMAX(2>=YT(1 *11-2. 
XHAX(3)=YT(ltl)+2. 

YMAXd  )  =  YT  (2  «l)-2  *666666 
YMAX(2)=YT(2tll*l .333333 
YMAX (3)=YT (2 *1)^1. 333333 
GO  TO  9C 

XMAX(l)=XHAX(2):XMAX(3>=YT(lfl> 
YMAX(l)=YHAX(2)=YMAX(3)=YT(2tl > 


CONTINUE 


END  MONTECARLO  SIMULATION 
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c 

loco 

20C0 


c 

c 

c 


c 


9St7 


6421 


WRITE  SOME  OF  THE  PLOT  G9INF  TO  TAPES 
F0RMATC5I3) 

F0RMAT(6E12«5) 

WRITE(8tlOOC}  KGtNFRMSfNPUNStITARG 
URITECet200C )  ALPHA«SIGAT»VARM«VARDFO 

CALCULATE  MEAN  AND  VARIANCE  STATISTICS 

CALL  FILSTCXFMEtXFME2#CNMEtCNME2tXFPE#XFPE2tCNPE*CNPE2#NRUNSt 
XNFRMStPDM.PDF ) 

URIT£C6t9Se7)  NRUNS t NFRMS tN? •NFREQtCOVfVARMf ALPHA t 
U  SICAT 

FORMAT<lHlfT10  **RUNS=**I3*T3f:  **FRAMES=*tI3tT73f*NUMBER  ZERO  PAD 
»  IlfTlOC t«NUMBER  FREQ  ZEROEO=* t 13 t/ tTl 0 t *6AUSSI AN  COVARIANCE 
#F5.2tT3e**MEASUREMENT  NOISE  VAR  I ANCE=*,F5«1 fT73t*SM00THI N6  ALPR 
tt  =*,F7.3#/#Tia* 

If  *TRUTH  MODEL  UNCERTAINTy=**F7.3t///> 

STOP 

END 


^VERITY 


DETAILS 


DIAGNOSIS  OF  PROBLEM 
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SUBROUTINE  OESCR7B(lHAXtXPAX«YNAXtSI6VOfSI6PVCtDELVf DELPVtStPEV 
.  »  T0tTlfN6tYT«ITAR6) 

REAL  IBAX(3)«XBAX(3>fYHAX{3l»SI6V0{3) tSIGPV0C3>tDELVC3>f OELPVC3 
REAL  S<12>«YT(2«1> 

C 

C 

C  THIS  SUBROUTINE  CONTROLS  SOME  OF  THE  INPUT  VALUES  NEEDED  TO 

C  DESCRIBE  THE  TARGET  TO  BE  TRACKED  AND  THE  MANEUVER  TO  BE  PERFORi 

C 

C  INITIALIZE  TARGET  INTENSITY  ASSUMING 

C  3  CIRCULAR  CROSS-SECTION  GAUSSIAN  TARGET. 

C 

IMAX(1)=2C. 

IMAX(2>=2C. 

IMAX(3)=20. 

=EADC5t561)  NG  i 

WRITE(6f 6C0C >  NG 

6CC0  FORMAT <1X»*NUMBER  OF  G  TURN  =*»I3t/) 

C 

rEA0t5*563l  TOfTltREVRT  , 

WFITE<6*6050 I  TOtREVRTtTl 

605C  FCRMAT<1X,*STARTING  TIME  OF  ROLL  MANEUVER  =• «F7.3«/f IXt 

n  *ROLL  rate  «REV/SEC>  =*fF7.3t/tlX,*STARTING  "^IME  OF  | 

AG-PULLINS  MANEUVER  =**F7.3I 

C  i 

562  FORMAT (F10.2) 

561  FOPMAT<I3) 

563  FORMAT <3F7. 31 
C 

C  •:EAD  INDICATOR  THAT  TELLS  WHETHER  TARGET  IMAGE  IS  TO  BE  STATIC 

C  OF  DYNAMIC*. .i:  DYNAMIC*  2  OR  O:  STATIC. 

C  ITARG=2  IMPLIES  SINGLE  SPOT  TARGET*  ITARG=  0  OR  1  IMPLIES 

C  THREE  SPOT  TARGET 

C 

FEAD<5*5611  ITARG 

IF  CITARG.EO.il  PRINT  **  "DYNAMIC  TARGET  IMAGE." 

IF  CITARG.NE.ll  PRINT  ♦*  "STATIC  TARGET  IMAGE." 

IF  (ITARG. NE.l)  GO  TO  IOC 
C 

(EAD  (5*563)  SIGVC 
UPITE(6*6100)  SIGVO 

61C0  FORMATCl  X**GAUSSIAN  DISPERSION  VALUES  IN  VEL  DIRECTION  =  **3F?.| 
FEAD(5*5L3)  SIGPVO 

UniTE(6*6200 1  SIGPVC  < 

62C0  FORMATCl X**6AUSSIAN  DISPERSION  VALUES  PERP  TO  VEL.  =  **3F7.3I  j 

READ(5*563)  OELV 

URITE(6«630C)  OELV  ‘ 

t3C0  F0RMAT(1X**DISTANCES  OF  ELLIPSOID  CENTERS  FROM  CG  OF  TARGET  IN 

«VEL.  DIR.  =  **3F7.3) 

REA0(S*563)  DELPV  j 

WRITF(6*6403)  DELPV  I 

64C0  FORMAT (1X**DISTANCES  OF  ELLIPSOID  CENTERS  F^OM  CG  IN  DIR.  PERP  j 

n  TC  THE  VEL  =  •*3F7.3) 

IF  (ITARG. EQ.l)  GO  TO  999 
IOC  CONTINUE 

C 

C 

/.CO  I 


noon  noon 


subroutine  OESCRIB 
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DEFINE  TRUE  TARGET  AS  3  INDEPENDENT  GAUSSIAN  FUNCTIONS  WITH 

DISPERSION  PARAMETER  =  CCV  WHEN  STATIC  IMAGE  OESIREDt  OTHERWISE 
WILL  BE  SET  UP  EACH  FRAME  WITH  A  CALL  TO  SUBROUTINE  LOCATE. 

C0V=3.0 
S<l>=l./COV 
SC  21=0. 

SC3»=C. 

SC4)=S(1  > 

S(5>=S(1 ) 

S(6)=0. 

S(7)=0. 

SC8)=SC1 ) 

S<91=S<1 » 

SC1G>=0« 

sen  )=0« 

SC12}=S<11 

DEFILE  GAUSSIAN  PEAK  LOCATIONS  BASED  ON  CENTROID  POSITIONt  YT 
FOR  STATIC  TARGET  IMAGE 

YTC1*1J=YT<2#1>=3*0 
C 

IF  CITARG.NE.O)  GO  TO  200 
XMAX<1)=YT(1«1) 

ft  XMAX(2)=YT<l*l>-2* 

XMAX<3)  =  YT(1«1>«2. 

YMAXC1)=YT(2«1)-2«66&G66 
YMAX<2)=YT(2fl»^1.333333 
YMAX<3I=YT <2 333333 
C 

GO  TO  999 

20C  XMAX(1)=XMAXC2)=XMAXC3)=YT(1 tl) 

YMAX(l)=YMAX<21=YMAX<3»=YTC2fl) 

C 

999  RETURN 
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SUBROUTINE  STATFMCXFHE«XFME2f CNMEtCNME2tXFMtXT tYT«UTfNRf NFRNS* 
t  PDIAGtPOH) 

REAL  XFHEC6«NFRNSIfXFNE2(6tNFAKS) tCNNEC2tNFRMS>fCNME2C2f NFRNS) 
REAL  XFM<6}«XT(B«l>*YT<2tl} 

REAL  UTf4}tPOIAG{8)tPOM<e«NFRMS) 

THIS  ROUTINE  GATHERS  THE  INFORMATION  THAT  UILL  BE 

REQUIRED  TO  COMPUTE  THE  STATISTICS  OF  THE  PREDICTIONS 
OF  THE  FILTER  PRIOR  TO  MEASUREMENT  INCORPORATION 

FIRST  COLLECT  THE  ERROR  IN  THE  PREDICTED  DYNAMIC  LOCATION 

DIF3=XFMf3)-'JT<l  ) 

DIF4=XFM<41-UT<2I 

DIF5=XFM<5I-UT<31 

DIF6=XFM<6I-UT<4> 

XFKECltNR )=XFMECltNR>«XFMCl>-XTCl«l> 
XFMEf2#NR>=XFME<2tNR)^XFMf2>“XTC2tl > 

XFME<3*NR)=XFME<3*NR>4.DI  F3 
XFMEI4,NR )=XFME<4«NFI«DIF4 
XFHE<5#NR>=XFME<5*NP>^DIF5 
XFMEf6fNR)-XFME(6fNRI«01F6 

NON  COLLECT  THE  SQUARE  OF  THAT  ERROR 


35 


XFMC2CltNRI=XFME2Cl«NR)^fXFM(l>-XTClfl>)**2 
XFME2<2tNR>  =  XFME2<2*NR)<»CXFMC2)-XTC2*l)>**2 
XFPE2«3tNRI=XFME2(3tNR>^DIF3**2 
XFME2<4,NR»=XFME2(4*NR>^DIF4**2 
XFRE2<5*NRI=XFME2C5»NP >♦DIF5*•2 
XFME2(6«NR>  =  XFME2<6fNR}-»0IF6ft*2 

COLLECT  ERROR  IN  CENTROID  PREDICTED  LOCATION  MINUS 

CNMECltNc  l=CNME<IfNP>^CXFM(l)*XFMC7>-YTCltin 
CNME<2tN»^  l=CNME<2*NP>^f  XFMC2  l♦XFM<a)-YT(^,ll  > 

COLLECT  THE  SQUARE  OF  THE  ERROR 


;*  45 


CNME2CltNR)=CNME2(l*NRI^CXFMCl )♦XFM^7>-YT(1*1 I)*»2 
CNME2<2*NRI=CNME2C2*NRI*CXFMC2)^XFMC8)-YT<2fl>>**2 
DO  100  I^ltE 

PORf  ItNR}  =  P0MCl«NRI-»SQRT(PDIA6CI  )) 

CONTINUE 


ADD  DYNAMICS  TERM  TO  THAT  REPRESENTING  CENTROID  FILTER  SIGMA 
DO  200  I=lf2 

P0R(I-»6fNRlsP0M(I-»6tNR>«SQRTfPDIAG(I)> 

RETURN 

END 
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5 


10 


15 


20 


30 


35 


40 


45 


50 
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SUBROUTINE  ST ATFP CXFPE*XFPE2 tCNPE tCNPE2»XTt YT *UT *XFP,NR * NFRMS * 
N  PDIAGfPDFl 

REAL  XFPE(6«NFRMS>f XFPE2C6tNFRPS)«CNPEC2«NFRMS> tCNPE2f2fNFRMS  > 
REAL  XTCPtl>*YT(2*l)#XFP<8> 

REAL  UT(4  )tP0PC8«NFRHSItPDIA6(e> 

C 

C  THIS  ROUTINE  GATHERS  THE  INFORMATION  THAT  WILL  BE 
C  REQUIRED  TO  COMPUTE  THE  STATISTICS  ON  THE  FILTERS 

C  UPDATED  STATE  ESTIMATES 

C 

C  COMPUTE  DIFFERENCES  THAT  WILL  BE  NEEDED 

C 

DIF1=XFPC1I-XTC1 «1 > 

DIF2=XFP(2>-XTI2*1I 
DIFF3=XFP<l>+XFP(7l-YTCltl > 

DIFF4=XFP<2>+XFP<8  1-YT«2»1 > 

DIF3=XFP(3)-UT<1 I 
DIF4=XFP(4)-UT<2I 
DIF5=XFP<5>-UTC3) 

DIF6=XFP(6»-UT<4> 

C 

c 

C  FIRST  collect  THE  ERROR  IN  THE  DYNAMIC  LOCATION  ESTIMATES 
C 

XFPE<ltNP)=XFPE<l tNRI+OlFl 
XFPE(2tNR)=XFPE(2fNR>+DIF2 
XFPE<3tNP.)=XFPE<3tNR)+DIF3 
XFPEC4*NR)=XFPEC4tNR l+DIFA 
XFPE<5*NR)=XFPE<5fNRI+DIF5 
XFPETStNR  »=XFPE<6fNP|+DIF6 
C 

C  NOW  COLLECT  THE  SQUARE  OF  THAT  ERRO® 

C 

XFPE2<lf NR)=XFPE2(1»NRI+DIF1*»2 
XFPE2<2.NR)=XFPE2C2tNR)+DIF2**2 
XFPE2<3t\RI=XFPE2l3*KP>+DIF3**2 
XFPE2(4fNR)=XFPE2<4fNR)+DIF4**2 
XFPE2<5fNR)=XFPE2<5tNR>+DIF5**2 
XFPE2C6tNR)=XFPE2C6#NR>+DIF6**2 
C 

C  NOW  COLLECT  THE  ERROR  IN  THE  CEVTROID  UPOA'^E 

C 

CNPE <1 tNR )=CNPEC 1 *NR l+DIFFS 
CNPE<2fNR)=CNPEC2tNRI+OIFF4 
C 

C  NOW  COLLECT  THE  ERROR  SQUARED 

C 

CNPE2CltNRI=CNPE2CltNR)+DIFF3**2 
CNPE2(2fNR)=CNPE2C2*NR>+DIFF4**2 
DO  ICO  I=lt8 

POPdtNR  I=PDPCItNR  >+SQRTCPOIAGCI)l 
lOr  CONTINUE 

C 

C  ADO  DYNAMICS  AND  ATM  FILTER  SIGMAS  TO  GET  CENTROID  SIGMA 

C 

DO  2Q0  I=l«2 

200  P0P(I+6fNR)=P0Pf I+6tNRI+SQRT(P0IA6(I ) ) 
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C 


RETURN 

END 
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SUBROUTINE  FILSTCXFNE*XFME2f CNME*CNME2#KFPE#XFPE2tCNPE*CNPE2* 
XNRUNStNFRHSf PONtPOP } 

REAL  XFMEC6tNFRHS>«XFN£2f6«NFRMS)«XFPE<6*NFRNSItXFPE2C6fNFRMS> 
PEAL  CNHEC2«NFRMS)«CNME2C2«NFRHS)tCNPEC2»NFRMS)«CNPE2C2tNFRNS) 
REAL  P0HC8fNFRKSl«PDPf8»NFRHS> 

C 

C  EXPLANATION  OF  DATA  STRUCTURES 

C  XFPE  IS  THE  XPOS  OF  THE  FILTER  AT  MINUS  TIME  ERROR 

C  THESE  ARE  ALL  COMPATIBLE  WITH  THE  ABOVE  ROUTINES 

C  ALL  NAMES  FOLLOtf  THIS  CODE 

C 
C 

C  THIS  ROUTINE  COMPUTES  THE  STATISTICS  ON  THE  FILTER  ERRORS 
C 

IF  (NRUNS.EQ.l)  GO  TO  10 
A=FLOAT<NRUNS) 

00  1  J=1«NFRMS  I 

DO  2C5  I=l«6 

XFPC(ItJ)=XFMEfI«J)/A 

XFPE(ItJ)=XFPECI«J)/A 

XFME2Clf J)=SQRTCABSCXFHE2CItJ)-A*XFHE(ItJ)**2>/CA>l.>> 

205  XFPC2(It J)=SaRT< ABSCXFPE2CI«JI-A*XFPECIt J)**2)/(A-1.>) 

DC  210  lsl«2 
CNPEIIf J)=CNME(I«J>/A 
CNPE(ItJ)sCNPC(l tU)/A 

CNMC2(Z«J>sS0RT<ABSICNNE2fI»J)-A*CNMECXtU>**2>/CA*l.)) 

21C  CNPC2(I»J>sSQRT(ABSCCNPE2(I»J)-A*CNPECIfJ)**2>/CA-l.)> 

00  1  IslfS 
POM(I«J}=POM(I«JI/A 

1  POPCItUlsPDPCIfJI/A 
C 

C  NOTE  THE  ORDER  OF  OUTPUT  TO  TAPES 

C 

c 

HRITEf8f99}  C ( f XFMECI t J) tXFME2 Cl t J)f PDMCI t J> tXFPECI t J>*XFPE2 Cl i 
«  P0PCIf«)H«J?l«NFPMS)»I=l«6l 

URITEC8«99)  C C CCNMECI « J) «CNME2C It J> *PDMC I*6« J) tCNPEC I f J) « 

«  CNPC2CItU)tP0PCI*6f J)>tJ=ltNFRMS Itl=lt2l 

10  CONTINUE 

C 

PRINT  *,  •filter  mean  ERRORS  PRIOR  TO  MEASUREMENT  UPDA’E:* 
WFITEC6t2}  C  CJtCXFMECItJ)tI  =  lt6) )f J=1 tNFRMS) 

2  FORMATC«lFRAME*t3Xt*X  PCSITI0N*t5Xt*V  POSITION* t5Xt*X  VELOCITY^ 

n  5Xt*Y  VELOCITY*t6Xt*X  ACCEL •* tBXt *7  ACCEL.*t/t 

n  2C0C/tief6ClXtF14.6)>t/} 

c 

PRINT  ♦,  "FILTER  MEAN  ERRORS  AFTER  MEASUREMENT  UPDATE:* 
URITEC6f2>  CCjtCXFPECI«J)«Irlt6>)tJrltNFRMS> 

95  F0PMATC3F15.6tlCX,3F15.6> 

C 

RETURN 

END 
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C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE  TRUTHTPHlTtBDtUT t OOROOTtHtSIBATtOT I 
REAL  PHIT(8«8)tB0(et4}t0DCe96>tK*Q0R00T(efe>tH(2fe) 
REAL  OOPTBfBItQDPRTCStB) 

REAL  UTC4) 


:  XT  : 
:  YT  : 
:  xiA  : 
xos  :  X2A  : 
:  X3A  : 
:  YiA  : 
:  Y2A  : 
:  Y3A  : 


THE  SOLUTION  TO  THE  TRUTH  MODEL  STATE  SPACE  EQUATIONS  IS 


XDCI*1>=  PHIT*XDCII  ♦  BO*UT  ♦  SQRTCQD>*UT 

WHERE  PHIT=STATE  TRANSITION  MATRIX 

SI6AT=  ATMOS  NOISE  STANDARD . DEVI A^ ION 

UT=  THE  CONTROL  INPUT 

BO=  THE  INPUT  MATRIX  FOR  THE  CONTROL 

UT=  GAUSS’ AN  NOISE  VECTOR 

QO=  COVARIANCE  MATRIX 


K=.382109544*SIGAT 

TD=1- 

A=14.14 

0=659.5 


ZERO  ALL  MATFIf  ES 

d:  1  1=1 f 8 

DO  1  J=l«8 
PHlTfI*J)=0« 

QDPOCT <I 9JI=0« 

QD<I tJ>=0« 

IF  (1.GT.2}  GO  TO  S 
HCI«J>=0. 

IF  (J.GT.4)  GO  TO  1 
BDCI 9J>=0« 

continue 


PH1TC1.1>=1. 
PHlT<2#2l=PHITCl9l > 
PHIT(3*3)=ExP<-A*D7) 

PHI T  <4  #4  »=EXPf-B*OT ) 

PHIT<4t5>=DT*EXPC-B*DT> 

PHITC595>=EXP<-B*DTI 

PHIT<6«6)=EXP(>A*0T> 

PHITC7*7>=EXP(-B*0T> 

PH1TC798)=DT*EXP<-B*0T1 
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9 

“  60 


70 

I 

I 

80 


C 

c 


c 

c 


c 

c 


I.  c 


1.0 

^•s 


M  95 


|o, 


;:H05 

fl 

.lie 


0 


k*.  -r-  -r-  ■- ' 


c 

c 


2 

C 

c 

c 


864 


865 

C 


PHIT(8t8  >=EXP<-B*OT> 


BOfltl>=DT 

BDC2t2}=DT 

B0(lf3)-DT*0T*.5 

BOC2t4>=OT*DT*«5 

UT Cl }=UT(2)=UT<3)=UT (41=0.0 

FACT=<K**2>*(A**2>*(B**4> 

FACT1=A-B 

FACT2=A*B 

FACT3s:2.*B 

GS1=FACT/(FACT1**4> 

GS2=FACT/CFACT1**3> 

GS3=FACT/(FACT1**2I 

P1=1.-EXPC-2«*A*0T> 

P2=1.-EXP<-FACT2*0T> 

P3=1.-EXPC-2.*B*DT1 

P4=DT*EXP<-FACT2*DT> 

P5=DT*EXPC-2.»B*0T> 


QO(ltl)=C. 

00(2«2)=Q0(lfl) 

QD(3f3)=(GSl*Pl)/(2«*AI 

QO<3t4l=P2*<6S2/FACT2**2-6Sl/FACT2)-P4*6S2/FACT2 

Q0<3»5>=GS2*P2/FACT2 

QO(4t3}=QOC3f4l 

aD<4f4)=P3*CGSl/FACT3-2.*GS2/FACT3**2^2.*GS3/FACT3**3)- 
n  P5*(-GS2/B^6S3*0T/FACT3^2.*GS3/FACT3**2> 

QD<4t5)=P3*<6S3/FACT3**2-GS2/FACT3>-P5*GS3/FACT3 
0D(5t3>=Q0(3«5l 
QD(5«4}=QD(4«5) 

00(5t5)=P3*GS3/FACT3 

FILL  OUT  REST  OF  GO  FATRIX 
DO  2  I=3t5 
DO  2  J=3t5 
Q0(I«3fJ^3)  =  00(I 
CONTINUE 

TAKE  CHOLESKY  SORT  OF  NON'OI AGONAL  PORTION  OF  QD  MATRIX 

DC  864  I=lf6 
DO  864  J=lf6 
0DP(It«l)  =  QD(I«2tJ«2> 

CALL  CHQLY(Q0Pf6f QOPRT> 

DO  865  1=1*6 
DC  865  J=l*6 

QDR00T(I«2tJ«2}=Q0PRT(I*J> 

H(l«l)=l. 

H(1*3>=1« 

H(1*4}=1. 

H(2*2)=l. 
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i 

t 

.10 


;  15 


20 


30 


35 


SUBROUTINE  PROP<PHXT«BDtUTfQDROOT tHtXT«YTtNtHfFRAHE«DTtIC«N6«NS 
«  RAN6E«Xl*YItZI*VX«VrtVZfTl> 

PEAL  PHlT(NtN) tB0CN«4> tUT (4) « OOROOTCNtNI t XTC Ntl ) tYTC H«1 ) t H<N«N] 
REAL  TEMPI C8tlltTEMP2C8«l)«TEHP3f8tl) 

REAL  lC(3t3> 

INTEGER  FRAME 
C 

12387  F0RMATC//tC2Xt8E10.3l) 

C 

THIS  ROUTINE  IMPLEMENTS  THE  STATE  TRANSITION  EQUATION, 


XT(I*1)=PHIT*XTCI>  ♦  BD*UTfI)  ♦  QDROOT*UD 

WHERE  XT=  STATE  VECTOR  CNXll 

PHIT=  STATE  TRANSITION  MATRIX  CNXNI 
BD=DETERMINISTIC  INOUT  MATRIX 

QDRGOTr  STATE  UNCERTAINTY  COVARIANCE  MATRIX  CNXN> 
WO=  GAUSSIAN  DISTRIBUTED  NOISE  VECTOR  CNXl) 

AND  THE  OUTPUT  EQUATION 

YT=H*XT 


VT=MEASUREABLE  OUTPUT  VECTOR  CMXl) 
H=  STATE  TO  OUTPUT  MAXTRIX  CMXN) 


WHERE 

CALL  C0MPUTC(XIfYI«ZI«VX«VY«VZtRAN6EfUT«FRAME*Tl«ICtN6fNS) 


CALL  NOISECTCMPlvNI 

CALL  MULTI 00P00T«TEMPlfNtNfl«TEMP2) 

CALL  MULTCPHITfXT*NtNtl*TEMPl) 

CALL  NULT<B0fUTtNf4flfTEMP3) 

DO  1  IslfN 

1  XTfI.ll=TEMFllItl)^TEMP2IIfl)*TEMP3fItl) 
CALL  MULTCHtXTtMfNtltYT) 

RETURN 

END 
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SUBROUTINE  CQMPUTECX# Y#2# VX* VV* VZtRAN6E«UTfFRAMEfTl*IC*NG*NS  > 
REAL  UTf4ltlCC3t3) 

INTEGER  FRAME 
C 

C  THIS  ROUTINE  COMPUTES  THE  APPROPRIATE  DETERMINISTIC 

C  CONTROL  INPUTS 

C 

OT=1./30. 

XO=ICfl*l } 

Y0=IC(lf2) 

20sIC(l*3l 

VXO=IC(2«l) 

VY0=IC<2*2) 

V20=IC(2t3} 

AXO=ICC3«l) 

AY0=ICC3«2) 

AZO=IC<3#3) 

C 

VOs:SORTC  VXO*  *2+WV0**2^  VZO**2  ) 

OMEGA=9«8*NG/WO 

VHOR 0=SOFT  f VX0**2*V20**2  > 

T=FLOAT(FRAHEI*DT 

C  FIND  UHAT  PART  OF  TRAJECTORY  TARGET  LOCATED  ON  AMD 

C  DETERMINE  APPROPRIATE  ACCELERATI ONt  VELOCITY  AND  POSITION. 

C 

^  IF  CT.GE.Tl)  GO  TO  10 

^  C 

X=XO*VXO*T*.5*T*T*AX0 

Y=YO^VYO*T*.S*T*T*AYO 

Z=Z0*WZ0*T*.5*T*T*AZ0 

C 

VX^TaAXO^VXC 

VY=T*AY0^VYC 

VZ=T*AZ0*V20 

C 

AX-AXO 
AV=AYO 
AZ-AZO 
GO  TO  50 

1  C 

10  ARG1=0MEGA*<T-T1 > 

C 

X=X0+T1* VXO* ,5*T1pT1*AXC^C (VXO*VO/VHORO> /OMEGA >*SINCAR61 ) 

Y= Y0^T1*VY0^.5*T1*T1*AY0^C VO/OMEGA >• Cl. -COS ( ARGl 1 > 

)  2=ZO+Tl*VZO*.5*Tl*Tl«A2C*f <V20*V0/VH0R0>/0MEGA>*SINCAPG1) 

C 

VX=< VXO*VO/VHORO>*COSCAPGl > 

VY=VC*SINCAP,G1 1 

VZ=C  VZO*  VO/VHOROMCOSCARGl » 

I  c 

AX=-<VX0*V0/VH0R0I*CMECA*S1N<A^61 > 

Ar=VO*OMEGA*COS(AR61 » 

A2=-CVZ0*W0/VH0R0>*CMEGA*SINC A^Gl I 
C 

5  50  RH0RS0=X*«2^Z**2 

RNGS0=RH0RSQ^Y**2 

RH0R=SQRT(RHCRSQ) 
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RANGEsSQRTCRNGSGI 

FACT=X*VX^Z«V2 

FACT1=FACT^V*WY 

ftHOOT=FACT/RHOR 

RNGD0T=FACT1/RANGE 

PHDDOTsf  RHOR*  <  X*  AX«2* AZ«VX*VX«VZ*VZ )-FACT*RHDOT I /RHORSQ 
C 

UT(1 »=(X*VZ-2*VX>/(RHORSQ*.00002> 

UT(2l=<RHOR«VY>Y*CCX*VX«Z*VZ}/RHORn/<RN6SQ*.OOOQ2} 

C 

UT(3)=fCX*AZ-AX«Z)*2«*FACT*CX*VZ-VX*Z)/RHORSQ)/CRHORSQ*«00002l 
UT C4»=( (RHOR* AY-Y*RHDDOT>-2.*CVY*RHOR-Y*RHOOT»*RNGDOT /RANGE)/ 

U  (RNGSQ*0.0Q002) 

C 

RETURN 

END 


e 
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1  SUBROUTINE  CROSS(A*BtPPOO> 

PEAL  AC3I tBC3)tPR0DC3> 

REAL  HAG 

5  C  this  ROUTINE  COMPUTES  THE  NORMALIZED  CROSS  PRODUCT  OF  TWO  ¥ECTO 

C 

PRCDCl)=A<2>*B(3>-AC3)*Bf2) 

PP0DC2I=-CAC1>*B<3I-AC3>*BC1>>' 

PR0D(31=AC1I*B<2I-AC2)*BC1) 

.0  c 

MAG=SQRT (PROO<1>«*2*PROD<2)**2*PRODC3>**2  > 

c 

IF  (MAG.EQ.l)  GO  TO  20 
DO  10  I=lt3 

L5  PR0D<I>=PR00CI»/MA6 

10  CONTINUE 

20  RETURN 

END 


non 
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SUBROUTINE  OCT C A*B*P‘^00> 

REAL  AC3>«B(31 

THIS  ROUTINE  PRODUCES  THE  SCALAR:  A  DOT  B 

PPOD^O. 

DC  10  I=lt3 
PROO=PROD*A(I >*8<I > 

CONTINUE 

RETURN 
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SUBROUTINE  INITFRMCEVOvEPVOvEPPVOtVXt VYtVZ) 

REAL  EV0f3)«EPV0<3l*EPPV0f3)fJC3> 

C 

C  THIS  ROUTINE  COMPUTES  THE  INITIAL  UNIT  VECTORS  OF  THE  TARGET 
C  REFERENCE  FRAME  AT  THE  ONSET  OF  SOME  MANEUVER.  IT  SHOULD  BE 

C  CALLED  WHEN  A  ROLL  OR  6-PULLIN6  TURN  IS  IMITATED.  XT  SHOULD 

C  SUPPLIED  WITH  THE  INERTIAL  VELOCITY  COMPONENTS  AT  THE  TIME  OF 

C  MANEUVER  INITIATION. ..CASSUMES  A  CONST.  SPEED  TURN  IF  PULLING  i 

c  ! 

c 

VMAG=SQRT(VX**2*VY**2*%Z**2I 

VH0R=SQRTCVX**2‘«>VZ**2) 

EVCC1}=VX/VMAG 

EV0f2}=VY/VMA6 

EVO(3)=VZ/VMA6 

C 

C  EPVO  IS  THE  RESULT  OF  NORMALIZED  CROSS  PRODUCT  OF  EVO  AND  J 
C 

J(1)=J<3}=0. 

J(21=l. 

CALL  CROSSCEVOvJtEPVOl 
C 

C  EPPVO  IS  THE  RESULT  OF  CROSSING  EPVO  AND  EVO  ...  (NOTE  ORDER) 

C 

CALL  CROSS(EPVOfEVOtCPPVO) 

WRlTE(6t200)  EVOfEPVO*EPPVO 

20C  FORMAT</flXt*TARGET  REF.  FRAME  VECTORS  AT  MANEUVER  INITIATION* 
i  /tlXt*EVO:*«T10t3F12.7t/«lX»*EPVO:*»T10t3F12.7t/*IX»*EPP 

#  fT10#3F12.7) 

RETURN 

END 
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SUBROUTINE  LCCATECXMAXt YPAXvSieVvSICPVfYTtUTtSyRAMGE* 

«  XvYfZtVXyVYfVZfFRAPEvTOtTlfREVRTtDELVtDELPVtSIGVOtSXGPVOfNGi 

*  EVOvEPVOtEVvEPVtRFfKS) 

REAL  XMAXC3> tYHAX<3)tSI6Vf3)«SlGPV(3)«YTC2tl )fUTC4) 

REAL  DELVC31t0ELPV<3>tS16V0f 3>,SIGPVOf3> 

REAL  S(12)tAC2  t2ltAT  C2 #21 •PC2 1 2 > tPPf 2*2 ) tTEPPC2«2 } 

REAL  EA(3)tEB{3>flER  C3) 

PEAL  EVO<3>*EPVO<3>*EPPVCC3>*EVC3)*EPV(3)#EPPVf3>*RFC2f3l 
INTEGER  FRAME 


THIS  ROUTINE  IS  USED  TO  LOCATE  THE  HOT  SPOTS  ON  THE  FLIR  IMAGE 
PLANE  UHEN  A  DYNAMIC  IMAGE  IS  BEING  TRACKED*  THE  CAUSSIAN  DISP 
PARAMETERS  APE  ALSO  COMPUTED  ACCORDINGLY  FROM  THE  REFERENCE 
VALUES  SPECIFIED  FROM  THE  INPUT  TO  THE  PROGRAM. 


DT=l./30. 

PI=3. 141592654 

DEFINE  REFERENCE  RANGE  RELATED  TO  SIGVO  AND  SIGPVO 
REFRNG=2000Q. 

TIME=FLOATCFHAME)/30. 

VHAG=S OR  T  <  VX*  VX*  V Y*  VY^ VZ*  VZ  ) 

VPL=SQRT(UTfl)*UTCl}«UTC2>*UTf 2>) 

VHAX::VMAG/CP.ANGE*0*0Q002) 

SNTH=UT(2 l/VPL 
CSTH=UT<1)/VPL 

DO  100  K>lt3 

SIGPV(K>=S1GPV0(K)*REFRNG/RAN6E 

SIGV(K)=SIGPVf K}*ll*><SIGVO(K)/SIGPVOfK}-l.>*VPL/VMAX> 

CONTINUE 

DEFINE  ALPHA t  BETAt  AND  RANGE  UNIT  VECTORS 

ALPHA=ATAN<Z/XI 

BETA=ATAN(Y/SQRT<X*X*Z*Z»» 

EA<1 )=-SIN<ALPHA) 

E A(2)-0. 

EA(3)=COr<ALPHA) 

EB(1  >=-CCS<ALPHA»*SINCBE’^A) 

EB<2)=C03(BETA) 

EB(3)=-SIN<ALPHA1 *SINCBETA) 

ER(11=X/RANGE 
ER(2)=Y/RANGE 
ERI3)=Z/F AN6E 

IF  (TIME.GE.Tl)  GO  TO  21C 

DEFINE  EVvEPVfAND  EPPV  IN  TERNS  OF  INIT  VECTORS  EVCvEPVOvAND  EPF 
GARKA  IS  ANGLF  OF  ROLL  FROM  INITIAL  ORIENTATION 
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IF  CCTIME-T0l.LE.OT>  CALL  INITFRHCEVO tEPWO.EPPVO # WXt VY* V7> 

GAKMA=2.*PI*REVRT*CTIME-^D  > 

DO  ?G0  K=lf3 
EVCK)=EVOCK) 

EPVCK>=CCSCGAHMA)*EPVOCK)-SIK'CSAMMA)*EPPVOCK) 

EPPVCK)  =  S:iNCGAMHA>*EPVOCK>^COS  CGAMMA>*EPPVOCK> 

CONTINUE 

IF  CTIME.lt. Tl)  60  TO  26C 

DEFINE  EV«EPV*EPPV  IN  TERMS  OF  FRAME  AT  ONSET  OF  6-PULLINS  TURW 
GAMMA  IS  ANGLE  OF  TURN  FROM  INIT  POSITION 

IF  C CTIME-T1).LE.0T>  CALL  INITFRM CEVO*EPVO*EPPVC* WX* VYt VZ> 

GAMMA=9.ft*NG*CTIME-Tl>/VMAG 
DO  250  K-lt3 

EWCK1=C0SCGAMMA)*EV0CK>^SINC6AMMA>*EPPV0CK) 

EPVCK>=EPVCCK) 

EPPVCK)=-SINC GAMMA >*EV0CK> ♦COS CGAMMA>*EPPVOCK) 

CONTINUE 

COMPUTE  REQUIRED  DOT  PRODUCTS  TO  PROJECT  A  VECTOR  FROM  TARGET 
FRAME  TO  ALPHA-BETA  PLANE 

CALL  OOTCEA»EV*AVOOT) 

CALL  DOTCEAtEPV*APVDOT> 

CALL  007  CEBtEVtli.'OOTI 
CALL  DOTCEB^EPVtBPVDOT) 

CALL  DOTCERfEVtRVDOT) 

CALL  DOTCER*EPVf RPVDOTI 

DO  300  K=lt3 

DETERMINE  LOCATIONS  OF  GAUSSIAN  PEAKS  BASED  CN  THE  TRUE 
CENTROID  POSITION*  YT 

XMAXCK>=YTC1 t 1 >♦ C DELVCK) • AVDOT^DELPV CK) • APVDOT)* CREFRNG/R ANGEI 
YMAXCK>  =  YT  C2 *  I >♦ C DELVCK > *BVP0T^DELPVCK >*BPVDCT)* CREFRNG/RANGE > 

CALCULATE  AND  LABLE  DATA  TO  BE  USED  TO  DETERMINE  THE  REALTIVE  « 
RANGES  OF  THE  TARGET  ELLIPSOIDS 

FIRST  ROU  CF  RF  ARRAY  CONTAINS  ELLIPSOID  LABELS 
SECOND  ROU  CONTAINS  RELATIVE  RANGES 

RFCl »K)=FLOATCK> 

RFC2*K>=DELVCK>*RVDCT^DELPVCK>*RPVD0T 

continue 

NOW  ORDER  THE  RANGES  SUCH  THAT  RFCltl)  CONTAINS  THE  NAME  OF  THE 
CLOSEST  ELLIPSOID*  E'*'C. 


DO  350  K=l*3 

IF  CRFC2*K).6E.RFC2*1>)  60  TO  320 
TEMPlsRFCl*!) 

TEMP2=RFC2*1 ) 

5 
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15 


;,2J 


.25 

\3u 


35 


or 


;-l  5D 

’i 

155 

i 

1  63 

ri65 

. 

I  70 

^  4 


32C 


35C 

C 

c 

c 

c 

c 

c 

c 

c 

c 


c 


ACC 

c 


C' 


6CC 


RFfltllsf-FCl  *K1 
PF(2tl)=RF(2tK» 

FFfl,K)=TEMPl 

RFC2*K)=TEMP2 

IF  (RF(2tK).LE.RFC2«3l)  GO  TO  350 
TEMPl=RF(lt3) 

TEPP2=P.F(2t3l 
RF<lt3l=RF<l fK> 

RF(2t3)=^F<2*K> 

RFC1*K)='^EMP1 

RFC2tKl=TEMP2 

CONTINUE 


P  -  MATRIX  WHOSE  EIGENVALUES  ARE  THE  INVERSE  COVARIANCES  OF  THE 
BIVARIATE  GAUSSIAN  INTENSITY  DISTRIBUTIONS 


PP  -  MATRIX  WITH  THE  SAME  EIGENVALUES  BUT  NOT  DIAGONAL  IN  GENER 
S  -  12  ELEMENT  ARRAY  THAT  WILL  CONTAIN  ALL  VALUES  OF  THE  THREE 
2X2  PP  MATRICES 

A  -  DIRECTION  COSINE  MATRIX  TO  HAKE  TRANSFORMATION  TO  FLIR  COO»^ 


A<1*11=CSTH 

AC1*2)=-SNTH 

A<2*l>=SNTH 

A<2*2I=CSTH 


00  ACO  1=1*2 
DC  ACO  J=l*2 
ATCltJ)  =  A<J«II 
PCI* JI=PF  CI*JI=0. 
CONTINUE 


L=0 

DO  SCO  K=l*3 
P(l*l)=l./SIGVfK)**2 
P(2*2>=1«/3IGPVC  Kl**2 
CALL  MULT CA*P«2*2*2*TEMP> 
CALL  MULTCTEMP*AT*2*2*2*PP> 
DO  SCO  1=1*2 
DO  500  J=l*2 
L=L^1 


S(L)=PPC I* J1 
CONTINUE 


GO 

TO  6C0 

IF 

(NS.EO.l  ) 

PRINT 

*  f 

IF 

(NS«EQ«1 I 

PRINT 

•  9 

IF 

Cf.S.EQ.l) 

PRINT 

IF 

(NS.EQ.l) 

PRINT 

IF 

CNS.EQ.ll 

PRINT 

#  • 

IF 

(NS.EQ.ll 

PRINT 

IF 

CNS.EQ.l) 

PRINT 

*  9 

IF 

(NS.EO.l) 

PRINT 

«  f 

CONTINUE 

IF 

(NS.EO.l) 

PRINT 

♦f 

RETURN 

END 


•INERTIAL  LOCATIONr  ■*X*Y*2 
•VPL="*VPL«»  VMAX="*VMAX 
•RANGE=»*RANGE*»  GAMM A=* *GAMMA 

■SIGV=»*SIGV*»  SIGPW=**SIGPV 
•EA=»*EA**  EB=»*FB 
•ER=»*ER 

•EV="*EV*"  EPV=*»EPV 
•A=”*t(A{I*J)*J=l*2>*I=l«2) 

■RF=»*RF 
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SUBROUTIf:E  IMTF  74/74  0PT=1  PMD«P  FTK  4.e«>S64 

SUBROUTINE  INlTFCTAFtVARDF«VARAF«VARVQ«VAROFO> 

THIS  ROUTINE  CONTROLS  INPUTING  VALUES  NEEDED  FOR  THE  KAL»>AN 
-  FILTER 

TAF=. 07072 

THIS  IS  THE  CORRELATION  TIME  FOR  THE  ATMOSPHERIC  MODEL  FOR  THE 
-  FILTER 

THE  VARIANCE  OF  THE  DYNAMICS  FOP  THE  FIL’ER 


FCRMAT<lXti»VARIANCE  OF  FILTER  DYNAMICS  =  *fF14.4) 
REA0<5«2)  VAPDFO 
WRITE(6tll  VARDFO 

FORMAT<lXt*VARIANCE  OF  FILTER  ATMOSPHERICS  =  *tF10.4) 
PRINT  -CA  NEGATIVE  SIGN  IMPLIES  ADAPTIVE  OFD>« 
VARDF=ABS<VAROFO> 

VARYQ=VARDF 
REAO{S«2>  VAPAF 
WRITE<6f3)  VARAF 
F0RMAT<F1C.4» 


THE  VARIANCE  OF  THE  ATMOSPHERIC  JITTER  FOR  THE  FILTER 


RETURN 

END 
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SUBROUTINE  FI LTER < TDF # WARDF t T AF t VARAP *DT* PHIF*QFD #QFDMAX ,QFDHI N| 
REAL  PHIF(8*6> tQFDC8tfi)tQF0HAX<S>«QFDniN(8) 

THIS  ROUTINE  SETS  UP  THE  STATE  TRA^iSITI0^1  MATRIX  AND  QFD  MATRIX 

TAF  CORRELATION  TIME  FOR  THE  ATMOSPHERIC  JITTER 

TDF  CORRELATION  TIME  FOR  THE  TARGET  DYNAMICS 

VARDF  TARGET  DYNAMICS  NOISE  VARIANCE 
VARAF  ATMOSPHERIC  NOISE  VARIANCE 


THE  SOLUTION  TO  THE  DYNAMIC  EQUATIONS 


XF(I*1  >  =  PHIF*XFCII 


FOR  PROPAGATION  OF  COVARIANCE  MATRIX  NEED  QFD 


EX=EXP<-DT/T OF> 

EX2=EX*EX 

FACT=1«-EX 

TD2=T0F*tdf 

TD3=TDF*TD2 

TD4=TDF*TD3 

T0F0T=T0F*DT 

DT2=DT*DT 

DT3=DT*DT2 

ZERO  ALL  MATPICIES 

D?  1  1=1,8 
DO  1  j=i,e 
FHIF<I,JI=0. 

QFOd  ,J}  =  0« 


PHIF<1,1) 

PHIFC1,3I 

PHIFfl,5» 

PHIF«2,2I 

PHIF<2,4) 

PHIF(2,6> 

PHIFC3,3) 

PHIF(3,5) 

•^HIFIAtA) 

PHIF<4,6) 

PHIFC5,5) 

PHIF{6,6> 

PHIF(7,7> 

PHIF<8,8I 


=1, 

=OT 

=TOF*CDT-TDF*FACT» 

=1. 

=OT 

=PHIF<1 ,5) 

=1. 

=TOF*FACT 

=  1. 

=PHIF(3,5) 

=EXP<-DT/TDF) 

=PHIF<5*5) 

=EXP<-DT/TAF| 

=PHIFI7,7> 


FILL  IN  MAX  QFD  VALUES  FOR  QFD  ESTIMATION. 
QFDMAXCI )sQF0MAXC2)=2. 


on  noon  ooo 
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QF0HAX(3)=QF0HAX(4)=15. 

QFDFAX(5>=QF0PAX(6)=25. 

QFDMAXC7}=QFDHAX(8>:0.5 

FILL  IN  MIN  QFO  VALUES  FCR  QFO  ESTIMATION. 

QFDHINfl >=OFOH2NI2)=0.1 
OFOM:NC3}=QFOMIN(4>=0.3 
QFDH:n(5}=QF0MIN(6>=4.0 
0F0MINf7)  =  0F0MINCe  )=C.031 


QFD<1*1)=WARDF*<T04^2.*CT03*DT-TD2*DT2^TDF*DT3/3.> 

«  -TDS^EX-tA.^OT^rOF^EXJ) 

QF0<lt3>=WAPDF*<TD3*Cl.-2.*EX*EX2)-2.*TD2*0T*FACT^TDF*DT2) 
QFD(lt5j=VARDF*CTD2-Cl.-EX2)-2.*TDFDT*EX) 

GF0{2«2}=QF0C1 •! ) 

QF0C2f4)=QFDClt3) 

QF0(2«6)=QF0(1 tS) 

QFD(3«1>=0F0(1 #3) 

QF0C3f3»=VARDF*(T02*C4.*EX-EX2-3.>*2.*TDFDTl 

0F0C3t5)=WARDF*TDF*FACT*FACT 

QFD(4t2)=QF0<2f4) 

QFD(4t4l=(JFO<3t3f 

QF0(4t6}:QF0(3t5) 

QF0(5tl)=QF0Cl«S) 

aF0(5f3>=QF0(3f5} 

QFD<5t5»=VAR0F*(l.-EX2l 

QF0(£t2)=QFDf2f6) 

aFD(6f4)=QF0<4t6) 

QF0(&«6)=QF0(5fS) 

QF0f7,7)=VARAF*Cl.-EXP(-2.*DT/TAF>) 

0FD<£t8)  =  QFD<7f7> 


RETURN 
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C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c- 

c 

c 

c 

c 

c 

c 

c 

c 

c 


1 


2 

c 


30 

c 


7420 


7412 


73CC 

C 

7423 


7419 


SUBRCUTINE  PROPF<NR#NS*PHIFf OFD*PFP*PFH*XFP*XFM*TEMP2fHANINDI 
REAL  PHIF(6«8}9QF0<et8l  tPFPC8»B)  tPFHCBtS)  tXFPCOf  XFHCB) 

REAL  TEHPl(e*8)tTEHP2l8*R»  fPHlFTCB*?  > 


THIS  ROUTINE  IMPLEHENTS  THE  STATE  TRANSITION 
-EQUATIONS  FOR  THE  FILTER 


XFMCI*ll=PHIF*XFPCH 


PFM=PHIF*PFF*PHIFT  ♦QFD 


WHERE  PHIF=FILTER  STATE  TRANSITION  MATRIX 

XF  =FILTER  STATE  VECTOR 
PFM  =CGW  FILTER  STATES  MINUS 
PFP  =COV  FILTER  STATES  PLUS 


rERFOFM  FILTER  STATE  PROPAGATION 


DO  1  1=1 f8 

00  1  J=l9e 

PHIFTCI, J)=PHIFC J,II 

CALL  MULTfPHIF*XFPtP.*8tl*XFM> 

CALL  MULTCPHIF fPFPf6f8tPtTEMPl > 

CALL  MULT (TEMPI fPHIFT  tS tE *8 * TEMP2 > 

DO  2  I=lf8 
00  2  J=lt8 

PFM<I» J>=TEMP2(I «J>«0FD(l9J> 

00  30  I=lt8 

IF  (I.LE.6>  PFP(IfI)=AMAXl(PFPCItI)»<10C.**((I*l)/2-2>)) 

IF  (PFMdtl)  •GT.O.)  GO  TO  30 

PRINT  Nf;  =",NR,«  NS  =»tNS**  PFMC»tI*"9  ■*I*»»  =**PFM(ItI> 

PFM(IfI)=ABS<PFM<IfI»> 

CONTINUE 

IF  (NS.NE.l)  GO  TO  1C 
WRITE  (6*7300) 

URITE(6*742C)  ( ( QFD (U« J) «U=1 *8 ) ) 

FORM AT (1 X* •QFD* «1X« (8614.5)) 

URITE(6*7422)  ( (PFP ( J« J) *^=1 *6 ) ) 

FORMAT (1 X**PFP« *ix * (eS14. 5)) 

!F  ( (lO.LT.r.F  •ANO.NR.LT.eC).OR.(RO.LT.NP))  60  TO  10 
F0RMAT(/*1X**0IAGCNAL  ELEMENTS  OFt*  ) 

WRITE(6f7423)  ( ( PF M( J* J) * J=1 *8 ) ) 

FORMAT (1 X**PFM* *1 X  * (6G14. 5)) 

IF  (MANIND.EO.l)  GO  “^0  10 

WRITE (6* 7419)  ( (TEMP2 (J* J) * J=1 *8) ) 

FORMAT  (1X**PUPD*  fix  *(8614.5)) 

WRITE (6* 7421)  ((PHIF (J* J) «J=1*B ) ) 

480 
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7421  F0F.PATC1X**PHIF**1X#C8G14.5»> 

10  RETURN 
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C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 
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SU8PCUTIKE  UPOATCZtLINH.fJLINHtXFPfXFMfPFPtPFB.UPDtRlNW.NStNRfHT 
REAL  ZC64)fLINH(64«8)tNLINHf E4>tLINHTf8t64l*XFP(8)tXFHCS> 

PEAL  PFPfSfE )tPFBf8f&>fRIMV<64»64>fTEMPl(8f64)«TEBP2(et6l 
REAL  XINV(6te)«0L0PP(8),HTPRES{B  > tHTRRf2> 

REAL  RESI0(£>4),PINVf8«8)t6AINK(8t64>fUP0f 8) 


THIS  ROUTINE  PROCESSES  ONE  MEASUREMENT  VECTOR  Z 
AND  ALSO  UPDATES  THE  FILTER  STATES  XFP 
Z  IS  THE  MEASUREMENT  VECTOR  OF  FLIR  MEASUREMENTS 

NLINH  IS  THE  NONLINEAR  INTENSITY  FUNCTION  AFTER  SMCOTHINS 
LINH  IS  THE  LINEAR  INTENSITY  FUNCTION 
XFP  IS  FILTER  STATES  PLUS 

XFM  IS  FILTER  STATES  MINUS 

PFP  COV  MATRIX  OF  FILTER  STATES  PLUS 
PFR  COV  MATRIX  CF  FILTER  STATES  MINUS 

RINV  INVERSE  OF  RFIL*  THE  FIL’^ER  MODEL  OF  SPATIALLY 
CORRELATED  NOISE 

TEMPI  HILL  HOLD  H-TRANSPOSE* RI NV 

PINV  WILL  HOLD  COV  MATRIX  MINUS  INVERSED 

TEMP2  WILL  HOLD  HTRINVH 

GAINK  KALMAN  FILTER  GAIN 

RESID  RESIDUAL 

UPD  GAIN  TIMES  RESIDUAL 

CLDPP  -  ARRAY  THAT  CONTAINS  THE  DIAC  ELEMENTS  OF  OLD  PFP  MATRIX 
HTRRES  -  ARRAY  THAT  HOLDS  HT*RIN V*RESID 


THE  EQUATIONS  USED  FOR  THE  UPDATE  APE: 


FIRST  FOP  COMPUTING  THE  COVAPINACE  PLUS  MATRIX 
USING  THE  INVERSE  COV  METHOD 

PINV<I*)=Pir,V<I-l*LINHT<H*RINVfI)LINHCI  ) 

PFP <I+>=C PINV <I*1!**-1 

K<I)=P<I^ILINHT<I  IRINVdl 

XFP<I»=XFMCI-MKCI  ICZdl-NLINHCD! 


FIRST  CREAT  LINH  TRANSPC^ED 


IF  ((NR*NS>.EQ.1I  MRITE<6t8528)  ( (PFMf I « J) « Jrl ,8 } ,* =1 | 

F0RMATClXt*PFM**/tClXteG14*5n 

DC  1  j=i«e 

OLOPP<J)=PFP<  JtJI 

DC  1  I  si ,64 

LINHTf Jtl)sLlNH(ItJ) 
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t-P  . . 

I- 


I 


SUBROUTINE  UPDA 


60 


i 


65 


7Q 

I 

i-  75 


i  cr 


.;  »5 

)■> 

I. 


c 

c 


c 

c 


8529 

€5  30 
C 


2 

C 

C 

C 


C 

C 

C 

C 


26 

29 


g«=5 


:  05 

r 


t* 


I 

r- 


30 

C 

c 


75C1 

C 

642C 

€424 


8426 

€422 

C 

C 


COMPUTE  THE  INVERSE  CF  THE  COV  PLUS  MATRIX 
CALL  MULT (LI NHT«RINVt6t64«64 •TEMPI) 

CALL  HULT(TEMP1«L1NH*8«64«8 •TEHP2) 

INVERT  THE  COVARIANCE  MINUS  MATRIX 
CALL  lNVERT(PFMt8«PINV) 

IF  ((NR*NS).EQ.l )  HRITE(6*6529)  ( (PI NV (I • J) « J-1 •€ ) •!=! tS ) 
FORMAT (1 X«*PI NV* •/•( IX •8614.5)) 

IF  ((NR*NS).EQ«1)  URIT£(6^8530  )  ( (TCMP2 ( I • J) • J=1 *6 ) • 1=1 tB ) 
F0RMAT(1X»*TEMP2U*«/*(1X»B614.5)) 

DC  2  I=1^8 
DO  2  J=l*8 

PINV(I.J)=PINV(I^ J)*TEMP2(I^J) 


CREATE  P(I*)=PF=' 

CALL  INVCRT(PINV^8«PFP) 

DC  30  1=1 *8 
IF  (I.GT.6)  GO  TO  29 

BOUNDING  OF  P  MATRIX  REQUIRED  WHEN  OFD  ESTIMATION  PERFORMED 
BOUND  VALUES  ARC  0.01 •  O.lt  AND  1.0  FOP  THE  POS^  VCL«  AND  ACCEL 
STATES 

BOUND=10.**((I*l)/2-3) 

FACT=SQRT(ABS(BOUND/PFP(T •!) ) ) 

PFP(I«I)=AMAXl(PFP(I«I)»BOUND) 

IF  (FACT.LE.l.)  GO  TO  25 

DO  26  «J=lte 

IF  (I.CQ.J)  GO  TO  28 

PFP ( I f  J) =PFP ( I *J ) *FACT 

PFP( J^I)=PFP(J^I)*FACT 

CONTINUE 

CONTINUE 

IF  (PFP( I«I).GT.O.)  GO  TO  30 

PRINT  *••  NR  =»^NR»»  NS  =*#NSt*  PFP(**I*»,  ■•I**)  =**PFP(I,I) 
PFP(I*I)=ABS(PFP(I*I)) 

CONTINUE 


CALL  MULT(PINV^PFPt6^&^e^XINV) 

IF  ((NR*NS).EQ.l)  URITE(6^7501 )  ( ( XI NV (I • J) • J=1 •& ) • I sl«B ) 
FCRMAT(lX«*X:NV*^/t(lX^66l4.S)  ) 

IF  ((NR*NS).EQ.l  )  WRITE(6^8420)  (  (PFPd  •  J  )  •  J=1  *8  )  •1  =  1  tB) 
FORMAT (1X»*PFPU**/*(1X*6G1 4.5)) 

FORMAT (1X«*L I NHT*«/«(1X^8G14.5)) 

IF  ( (NR*NS).EQ.l )  URITE(6*6426)  ( (RINVfl • J) • J=1 *64) 

^•I=l»2) 

F0RMAT(lX«*R*^/t(lX»8G14.5)) 

FORMAT (2X«*RINV  HAD  AT  LEAST  ONE  NEGATIVE  VALUE*) 

COMPUTE  THE  KALMAN  FILTER  GAIN 
CALL  MULT(PFPtTEMPl«e«8«64»6AINK) 

IF  ((NR*NS).E0.1 )  HPITE(6«8417)  ( (GAINK( I • J) • Jsl *64) •!=! *2) 
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8417 

C 

C 


3 


8423 

P444 

8410 


8419 

4 

C 

C 


F0RMAT(lXt*GAINX*«/t6ClX*eG12.5t/)f//tlX«*6AINY*f/t8  ClXt 8612.5# 

COMPUTE  STATE  MEASUREMENT  UPDATE 
FI8AX=0. 

DC  3  1=1 *64 

FlMAX=AMAXlfFIMAXtZCI  )> 

RESIDfI)=Z(I >-KLINH(I> 

IF  f fNR*NS}.E0.1 >  WftITEC6#8418)  CRES IDf I > *1=1 *64) 

IF  C(N‘R*NS).EQ.l  )  WPITE  C6  *8423  )  (Z  (I  )  *1=1  *64  ) 

IF  ((NR*NS).EQ.1)  URITEC6*E444)  f  NLI NH( I > « 1=1 *64 > 

FORMAT (1 X **Z« */*  C IX *861 4.5)) 

FCRMATC1X«*NLINH**/*C1X*8G14.5)) 

FORMAT (1X**RESI0*«/*C1X*8612.5>) 

CALL  MULT  <TE  MPl *RES 10*8  *64  *1 *HTRRES ) 

IF  (NS.EO.l)  CALL  PR INTCHTRRES *1 *8*10HHT*RI*PES  ) 

CALL  MULT CPFP*HTPRES*8*8*1*UPD) 

IF  C (NR*RS)-EQ.l )  UR lTEC6*g419>  UPD 
FORMAT  Cl x,*UPO* *8  612.5) 

00  4  1=1*8 

XFP<I)=XFM(I )*UPDCI) 


RETURN 
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5 


5 


3 


5 


3 


5 


5 


SUBROUTINE  QAOAPT (FR AMEtTR XXT t UPO t PUPOvQFDt QFDBIN t OFDNAX « 
ff  PFPvVAROFOtTDFvVARAFtTAFvVARYOtNS) 

INTEGER  FRAME 

REAL  UPO(&)tPUPD(8t8}tOXDXTCe*e) tPFPCSfS) 

REAL  QF0(atd)«QF01C6t8)«0FDMAXfa)fQFDMIN<81 
C 

C  THIS  ROUTINE  PERFORMS  ADAPTIVE  QFO  ESTIMATION 

C  THE  INITIAL  VALUE  OF  QFO  IS  REDUCED  LINEARLY  DURING 

C  ACQUISITION.  THEN  ESTIMATION  BEGINS  BY  FRAME  15  AT  THE  LATEST. 

C 
C 

TRXXTO=TRXXT 

IF  (FRAME. NE.IJ  TRXXT=0. 

C 

DO  110  I=lf8 
DO  IOC  J=l*6 

OXDXTCIt J)=UPD(I }*UPD(J) 

QFDl(ItU)-OFD(I« J) 

100  CONTINUE 

TRXXT=:TRXXT4DXDXT(I*I> 
lie  CONTINUE 

c 

TRXXT=0.fc*TRXXT040.2*TRXXT 
IF  (VARDFO.GT.O.)  GO  TO  74 
C 

IF  <FL0AT<FRAME».LT.6.>  GO  TO  ?00 
IF  (FL0AT(FRAKE>.GC.15.)  60  TO  250 
IF  (TRXXT.GE.IOOC.)  GO  TO  250 
GO  TO  74 
C 
C 

C  ACQUISITION  SCHEDULE  CHANGE  OF  QFD 

C 

2C0  VARYQ=VARYQ4VARDFO*0.06444 444444 

CALL  OFDCOMP<QFDtVARYQ*TOF  tVARAFtTAFI 
GO  TO  74 
C 

C  ESTIMATION  OF  QFD 

C 

25C  IF  (NS.EQ.ll  PRINT  • 

IF  (NS.EQ.l)  PRINT  •*"  QFD  ADAPTATION  AT  FRAME  ••FRAME 

30C  DO  400  Irlt& 

DO  400  J=ltF 

400  QFDCI  t  JI^DXDXTd  f  J}'4PFP(ItJ)-PUPD(ItJ) 

C 

C  BOUND  QFD  TO  PREVENT  NEGATIVE  EIGENVALUES 

C 

C  BOUNDING  QFO 

C 

DO  84  1=1 td 
QFACTOR=l. 

IF(0FD(1«I).6T.C.I  60  TO  86 
QFACTOR=C • 

QFD(I«I  >  =  AMAXl  (0.1t(QFDMlN(l)**2M 
GO  TO  85 
86  CONTINUE 

IF(SQRT<QFO(Itin.6T.QFOMAX(I))  QFACTOR=OFDMAX(  I ) /SQRTCQFDCI  tl 


485 


o  o  o 
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LOWER  BOUND  QFD 

IF  fSQRTCQFDCI fl ) )*LT«QFDHINCI ))  GFACTOR=QFDMINCI ) /S QRT ( QFOC I f I> 
C 

IF  C^S.EO.IJ  PRINT  QFACTOR  NUMBER  "tit*  =  "tOFACTOR 

IF(QFACTOR*EQ.l. )  GO  TO  84 
QFOCI fI)=QFACTOR**2*QFOfIfI) 

85  CONTINUE 
DO  82 

IFd.EQ.J)  GO  TO  82 
QFOCIf J>=QFO(I tJ)*GFACTOR 

82  CONTINUE 

DO  8  3  K=l«8 

IFfI.EQ.K)  GO  TO  83 

GFD(K«I}=QF0<K«1)*0FAC70R 

83  CONTINUE 

84  CONTINUE 

DO  73  1=1*8 
DQ  73  d=l*8 

73  QFDfItJ)=  •2*QF0CI*J)«.B*QF0if I*J> 

74  CONTINUE 
RETURN 


on.  o  o  o  r»  n  M  non  n  o  n  o  o  o 
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SU8R0UTI NE  QFDCOMP«GFDsyARDF#TDF*VARAF*TAF» 

REAL  QF0(6tB> 

THIS  ROUTIKE  COMPUTES  CONSTANT  OFD  MATRICES  THAT  CORRESPOND  TO 
THE  FIRST  ORDER  GAUSS-HARKOV  MODEL.  THE  ROUTINE  IS  REPEATEDLY 
CALLED  FOR  OFD  ADAPTATION  DURING  TARGET  ACQUISITION. 

DT=l./30. 

EX=EXPC-DT/TOFI 

EX2=EX*EX 

FACT=1.-EX 

TD2=TDF*TDF 

TD3=TDF*T02 

TD4=TDF*T03 

TDFDT=TDF*DT 

0T2=DT*0T 

OT3=DT*DT2 

ZERO  QFD  MATRIX 

00  1  1=1 #8 
00  1  J=lf8 
QFDCI*J)=0. 


QFD<ltll=VAR0F*(TD4^2.*<TD3*DT-TD2*DT2*TDF*DT3/3.1 
X  -TD3*EX*<4.*OT^TDF*EX>» 

OFDCl *3>=VARDF*CT03*CI.-2.*EX*EX2)-2.*TD2*DT*FACT»TDF*0T2> 
QFD(lt5l=VAR0F«(TD2*Cl.-EX2)-2.*TDFDT*EX> 

QF0(2«2)=QF0(1«1} 

QF0(2«4)=QFD(lt3} 

QFO(2f6>=QFO(l t5 ) 

QF0C3tl>=0FD(lt3) 

QFDC3t3»=VAR0F*CT02*f4.*EX-EX2-3. )♦2.*TDFDT) 

0FD(3*5)  =  VAR0F*TDF*FACT*FAC^ 

QF0(4«2>=0F0(2«4) 

0F0(4f4)=QFD(3  t3) 

QF0(4«6)=QFDC3f5} 

QFO(5«1}=QFO(1«5I 

0FD(5t3)=QFD(3t5l 

QFDC5f5)=VARDF*<l.-EX2) 

QFDf 6t2)=QF0(2«6l 
QFD(8t4>=QFD<4 f6) 

QF0(6tG}=QF0(St5} 

QF0(7,7I=VARAF*(1.-EXP(-2.*D7/TAF>) 

QFD(&«8)=QF0(7f7) 


RETURN 
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SUBROUTINE  INPUTS ( I HAX«S •XHAX«  YMAXvN'tNZf  X«Y« DATA vCENXtCENYt 
MRFtNRvNS) 

^EAL  APG(3)tIMAX(3)«ISIG(3)tINTEN(3>«S(12>«XMAXf3)tYMAXC3) 

REAL  RF(2f31 

INTEGER  A C31«L0BE<24t24 It OVERLAP 
COMPLEX  OATACNtM 

THIS  ROUTINE  DETERMINES  REAL  MODEL  INTENSITY  AND  CENTRqio 
VALUES  FOR  AN  6X8  PIXEL  FOV.  ZERO  PADDING  IS  ACCOMPLISHED  BY 
CENTERING  THE  6X8  PIXEL  FOV  WITHIN  A  NULL  NXN  SPACE  WHEN  NZ>0. 
THE  COORDINATE  SYSTEM  IS  AS  DEFINED  BELOU: 


(OtC  I 


THE  INTENSITY  PATTERN  IS  DEFINED  TO  BE  3  GAUSSIAN  DISTRIBUTION 
CF  INTENSITY  I  MAX<I>tI=lt3  LOCATED  AT  XMAXd  I  tYMAX  Cl  >  tl  =  l  1 3 
WITH  COVARIANCE  Sflltl=lt3.  THE  UPPER  LEFT  CORNER  OF  THE  8X8  P 
FOV  IS  DEFINED  TO  BE  LOCATION  XtY  MICRORAD. 

THE  INTENSITY  AT  EACH  PIXEL  IS  DETERMINED  BY  INTEGRATING  THE 
INTENSITY  OF  25  EQUALLY  SPACED  SPOTS  WITHIN  THE  PIXEL. 


IMAXCI)  -  MAXIMUM  INTENSITY  OF  THE  ITH  INTENSITY  DISTRIBUTION 
ISI6CI)  -  THE  ONE  SIGMA  INTENSITY  OF  THE  ITH  DISTRIBUTION 
INTENCIl  -  CONTRIBUTION  TO  thE  OVERALL  INTENSITY  AT  A  PARTICUL 
POINT  FROM  THE  ITH  INTENSITY  DISTRIBUTION 


ACII  -  FLAG  INDICATING  WHETHER  INTENCIl  >=  ISI6CII  ItYESt  2Z 
RFCII  -  THREE  ELEMENT  RANGE  FLAG  ARRAY:  THE  FIRST  ELEMENT 

CONTAINS  THE  NUMBER  OF  THE  DISTRIBUTION  RELATED  TO  THE 
TARGET  ELLIPSOID  CLOSEST  TO  THE  INERTIAL  ORIGIN  SECOND 
AND  THIRD  ELEMENTS  APPLY  SIMILARLY 


ZERC  OUT  FOV  SPACE 

DO  1C  1=1 tN 
DO  10  J=ltri 
LOBECItJI=0 
DATACItJI^O. 
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SUPY  =0. 

SUMAV6=C. 

:F<N.LT.8)  N=8 

IFCCN-8>/2-LT.NZ>  KZ=<N-e)/2 

LM=N7+1 

LP=N-NZ 

lB=(N-8)/2*l 

DO  1  I=LHtLP 

DO  2  J=LKtLP 

AVG=0. 

DIVIDE  PIXEL  I«J  INTO  25  SEGMENTS 
DO  3  Kl=lf5 
DO  4  K2=l95 

IF  C  CK1.1i£.3.0P.K2.NE.3).AND.(I.LT.9.0R.I.GT.16  .OR.  J.LT.9.0R. 
#J.6T.16))  GO  TO  4 
0ELY  =  (I-IB)*1*C<-<K1-1I**2 
OELX  =  <  J-IB)*l-0-KK2-ll*.2 
XP-X+DELX 
VP=Y^DELY 
X1  =  XP-XMAX<1  > 

Y1=YP-YMAX(1> 

X2=XP-XHAX<2» 

Y2=YP-YMAX 121 
X3=XP-XMAX<3i 
Y3=YP-YMAX<3) 

ARG<l)=-*5*<<Xl**2*SCl))*CXl*Yl)*fSC2>*S(3l)^<Yl**2*S«4)>) 
APG<2)=--5*CfX2**2*S<5)l^CX2*Y2)*(S<6)4.SI7))*(Y2**2*SCe)  11 
AR6<3)=-.5*(<X3**2*S<9))^CX3*Y3)*(S(10)*S(11 1 )*(Y3**2*SC12)) 1 


IFLAG=0 

FXY=0. 

NURSIG=0 
DO  2C0  L=lt3 

IF  <ARG<L}.GT.-225. 1  GO  TO  150 
ARG(LI=-225. 

IFLAG=1 

ISIG(L)=C .60653C66*IMAXCL1 
If.lTEN<Ll  =  IMAX<LI*EXP(ARGCL)) 

A(L 1=0 

IF  lINTENCLl.GE.lSIGail  AfLl^l 
NUMSIG=NUMSIG*A<L) 

CONTINUE 

DO  300  L=lf3 

IF  NUHSIG=0  -"HEN  ADO  ALL  THREE  COMPONENTS  TO  FXY 

IF  (NUMSIG.GT.CI  GO  TO  250 

FXYrFXY+INTENCL) 

IF  (FXY.GT.C.l  GO  TO  300 
M=INT(RFC1*L1I 


FIND  CLOSEST  CONTRIBUTICN  WITHIN  ONE  SIGMA  BOUND  AND  EQUATE  FXY 
IF  <A(M>.EQ.l  .AND.  FXY.EQ.O.l  FXY=INTCN<M> 

IF  (K1.EQ.3.AN0«K2.EQ.3I  LOBE(I«Ut=M 
CONTINUE 

IF  (NUMSIG.EO.Ol  FXY=FXY/3. 
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AVG=AV6*FXY 

SUFX=SUMX*XP*FXY 

SUPY=SUMY*YP*FXY 

CONTINUE 

CONTINUE 

OATA(I«J)=AVG 

IFCI.&E.S.0R.I.LE.16.CR.J.GE.9.0R.J.LC.16)  DATA (7  « J)=:DATA(I« J> 
WRITEC6<100)  If J«DATA(X«J> 

F0RNAT(2Xf2I4f2XtG12.5} 

SUKAVG=SUHAVG*AVG 

CONTINUE 

CONTINUE 

CEKX=SUMX/SUMAV6 

CENY=SUMY/SUMAVG 

IF  (NS.NE.1*0R.<NR/5>*5.NE.NR)  GO  TO  510 
PRINT  *f  "ELLIPSOID  CONTRIBUTIONS" 

DO  5P5  K=lfe 

URITE(6f500)  CLOBEf 17-Kf J) fJ=9fl6) 

FORMAT<T2  f8I2> 

CONTINUE 

IF  CNS*IFLA6.E0fl>  WRITEC6f555l 

FORMAT<lXf*INTENSITY  DATA  ARTIFICIALLY  BOUNDED  LOST  TRACK*! 
RETURN 


f 
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10 


15 


20 


SUBROUTINE  SI NGLE « IPAX*S* XT* VT*XF# YFt DATA *OX#DY #NR #NS > 

COMPLEX  D ATA < 24*24 >*DXC24*24),DY (24*24) 

REAL  IMAX(3)*S(12) 
integer  L0BE(24,24) 

C 

C  THIS  ROUTINE  IS  USED  TO  GENERATE  A  SINGLE  SPOT  IMAGE 

C  IT  ONLY  DETERMINES  INTENSITY  VALUES  AT  THE  CENTER  OF  EACH  PIXEL 

C 
C 

ITARG=0 
IFLAG=0 
DO  10  1=1*24 
DO  10  J=l*24 
LOBEd  *J)=C 
DX(I*J)=0. 

OY(I«J)=0« 

10  DATA(I«J)=0. 

DO  100  1=1*24 
DO  ICO  J=l*24 
XI =XF-XT^FLOAT ( J-1 2 )-0 .5 
Y1=YF-YT>FLOAT(I-12)-0«5 

ARG=(-«5* (X1**2*S<1)*<X1*Y1)*CS(2)*S(3))+ 

If  Y1*«2*S(4))) 

IF  IARG.LT.-225*)  IFLA3=1 
IF  (ARG.lt. -225.)  ARG=-225. 

OATA(I*J)=IMAX(l )*EXP(A»6) 

OX(I*d)=-(-Xl*S(l )-.5*Yl*(S(2)*S(3)))*DATA(I*d) 
DY(I*d)=-(-Yl*S(4)-.5*Xl*(S(2)^S(3)) )*DAr A(I*d) 

IF  (OATA(I«d).GE.(.60653*IMAX(l)))  LOBE(I*d)=l 
ICC  CONTINUE 

DC  505  K=l*8 

IF  (NS.EQ.l)  WRITE(6*500)  (L0BE(17-K*d)*d=9* 1€) 

500  FORMAT (*  1  SIGMA  IMAGE**8(T20 *BI2  )*/) 

505  CONTINUE 

510  IF  (NS*IFLAG.EQ.l)  WRITE(6*555) 

555  F0RMATC1X**INTENSITY  DATA  ARTIFICIALLY  BOUr.DED  —  LOST  TRACK*) 
RETURN 
END 
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SUBROUTINE  J OEALf IMAX«Sf XMAX t YMAXf NtNZ tX t Y«DATA «DXtDr tPF tiTARG t 
»NS> 

REAL  ISI6(3)tINTENC3)«PFf2t3>tAR6f9l 
REAL  IMAX(3}fXMAX(3>*YMAXf3>tS(12) 

INTEGER  A(3)t0VERLAP#L0BE(24#24) 

COMPLEX  OATACN»N>«DX(N*N)fOY(N«N) 

C 

C  THIS  ROUTINE  COMPUTES  THE  INTENSITY  DATA  FOR  A  THREE  SPO^  IMAGE] 

C  VALUES  ARE  COMPUTED  AT  THE  CENTER  OF  EACH  PIXEL* 

C 

IFLA6=0 


IF 

(NS.EG.II 

PRINT 

*• 

■IN 

ideal:" 

IF 

(NS.EQ.II 

PRINT 

•x=« 

tXt"  XMAX(II=*t 

XMAX 

IF 

(NS.EQ.II 

PRINT 

*# 

■Y  =  » 

*Y**  YMAX(II="t 

YMAX 

IF 

(NS.EQ.II 

PRINT 

*f 

•S= 

”«(S(II«I=1 «4I 

IF 

(NS.EQ.II 

PRINT 

** 

m 

•#(S(II*T=5#ei 

IF 

(NS.EQ.II 

PRINT 

** 

m 

■t (S(I I#I=9fl2I 

C 

DO  10  I=l*% 

DO  10  u=itri 
DATACI f J>=0. 

OX(ItJ)=^C. 

DY(I*J»  =  0.. 

LOBE(ItJ)=0 
10  CONTINUE 

IF<N*LT*fel  N=8 

!F(<N-81/2.LT*NZ)  NZ=<N-&)/’2 

LM=NZ*1 

LP=N-N2 

IB=Cr -8)/2*l 

DO  1  I=LM,LP 

DO  1  J=LM«LP 

Xl=X^FLOAT<J-IBI-XMAXCl »**5 

X2=X+FLCAT<J-IB)-XMAXC2)**5 

X3=X^FLCAT(»|-IBI-XMAXI3)^*5 

Yl=Y>FLOAT<I-IBI-YMAxn 

Y2=V^FL0AT<I-IB>-YMAXC2I*.5 

Y3=Y*FLOAT<I-IB)-YMAXC31**5 

ARGCl l=-*5*< (X1**2*SC1 »>^(X1*Y1)»ISC2>^SC3I)^CY1**2*SC4> II 
A- GI2)=-.54C  CX2**2*S  C5I >♦! X2 *Y2 I  *  CSC  6 >♦$ C 71 >♦€ Y2**2*S CR 1 1 1 
ARGC3)=-.5«<  <X3*«2*S<9  n♦CX3*Y3)*  CS(10)»S  <111  )♦! Y3**2*SC  121 1 1 

C 

ARG<4)=-X1«SC1I-.5*V1*<S<2>^SC3)> 

APGf 5)=-X2*SC5I-.5*Y2*(Sf6)*S(7| I 
ARGC6I=-X3*S(9I-*5*Y3*<S(10>^S  (11 II 
A06(7I=-Yl*SC4I-*5*Xl«CS(2I»Sf 3II 
AR6(RI=-Y2*S(3I-.5*x2*(SC6I^£(7I I 
AP6<9I=-Y3*S(12I-.5«X3*<SC10I*S(11 II 
C 
C 
C 

:flag=o 

DC  200  L=l*3 

IF  (AR6(LI*GT.*225*  I  GO  >0  150 
ARG(LI=-225* 

IFLAG=1 

15C  ISIG(LI=0*G06S3066*IMAX(LI 
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INTEN(L)=IMAX(LI*EXP<ARGCL)I 

A(L}=0 

IF  (INTE^(L}  .GE.ISlGCD.AND.ITARG.EQ.ll 
CONTINUE 


CVERLAPrC 
DO  3C0  L=lt3 

IF  (GVERLAP.CQ.il  GO  TO  300 
K=INT(RF(1,LI J 
cverlap=oveflap*ach> 

LOBE  IS  ARRAY  INDICATING  WHICH  ELLI 
IF  (OVERLAP. EQ. 11  LCBE(I*»I)=H 
OATA(I«J)=DATA(I« J)«INTEN(H) 
DX(I«J1=DX(I«J)^ARG(H«3>«INTEN<M> 
OY(I«Jl=DY (I tJ)«ARG(M«E>*INTEN(Ml 
CONTINUE 

IF  (OVERLAP. NE.QJ  GO  TO  1 
IF  NOT  WITHIN  ONE  SIGHA  BOUND  OF  ANY 


A(L1=1 


ELLIPSOID  data  CAHE  FROM 


ELLIPSE  THEN 


AVERAGE 


5679 

C 


DATA(IfJI=DATA(ItJl/3. 

DX(ItJ)=DX(I« Jl/3. 
DY(L«Jl=OY(I«JI/3. 

CONTINUE 

IF  (NS.CO.l  .AN0.((NR/S)*5>.EQ.NR> 

U  J=efl7l*I=Btl7l 

FOPF.ATt*  ELLIPSOID* #10 (T15fl 01 2#/)) 


WRlTE(6t5679>  ((LOBECIfJ)# 


IF  ((IFLAG.EQ.ll.AND.CNS.EQ.lll  WRITE(6«555) 
F0RMAT(/«1X**INTENS1TY  DATA  ARTIFICIALLY  BOUNDED 
return 


•IDEAL**I 


o  o  o  o  o 
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SUBROUTINE  SMCOTHf DATA tSOATA • ALPHAt N« ITER AT> 

COMPLEX  OATA(KtN)tSDATA<N«N> 

THIS  ROUTINE  SMOOTHS  RAW  DATA  ARRAY  DATA  USING  EXPONENTIAL 
SMOOTHING,  weighting  FACTOR  ALPHA  IS  USED  TO  GENERATE  THE 
SMOOTHED  DATA  IN  ARRAY  SDATA.  THE  PARAMETER  ITERATICN  IS 
USED  TO  DETERMINE  THE  WEIGHTING  FACTOR  WHEN  FEWER  THEN 
I/ALPHA  ITERATIONS  HAVE  BEEN  DONE. 

A=1./ITERAT 

IFfA.LT. ALPHA!  A^ALPHA 
DO  3  1=1 tN 

DO  3  J=ltN 

SDATAdt  J!=A*0ATA(I  tJ!«fl.*A!*SDATA(I*Jl 

RETURN 
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25 


I 


•-  35 


1 

:  40 


i 


f 


SUBROUTINE  SPTMC SIGMAS « H) 

DIMENSION  P 164,64) tC(5) 

DATA  C/. 3679,. 24 31 ••1353, •1069, .0591/ 

C 

C  SET  UP  SPATIAL  NOISE  CORRELATION  COEFFICIENT  MATRIX 

C  USING  SECOND  NEAREST  NEIGHBOR  CORRELATION^ 

C 

c 

C  C  IS  THE  ARRAY  CONTAINING  THE  NON-ZERO  ELEMENTS 

C  CORRESPONDING  TO  THE  DISTANCES  TO  NEIGHBORING  PIXELS^ 

C  THE  ARRAY  VALUES  ARE  EXP«- DIST ANCE  IN  PIXELS) 

C 

C  SIGMAB  IS  THE  BACKGROUND  VARIANCE 

C 

C  R  IS  THE  M«*2  BY  M**2  CORRELATION  MATRIX 

C 

N=M**2 

DO  30  1=1 •N 
CO  3C  J=1,N 
R(I,J)=0.0 
3C*  CONTINUE 

DO  36  I=1,N 
•^(I.Dsl. 

IF  (I.GE.64)  GO  TO  36 
R<I,I*1)=CC1) 

IF  (I^GE.63)  GO  TO  36 
MI,I^2)=CC3) 


IF<I 

•  &£• 

59) 

GO 

TO 

36 

'  <1, 

I^6) 

=C<4 

) 

IF<I 

•  GE. 

58) 

GO 

TO 

36 

PCI* 

I*7) 

=CC2 

:) 

IF<I 

•  GE. 

57) 

CO 

TO 

36 

F<I, 

I*8) 

=C<1 

) 

IF<I 

•  GE. 

56) 

GO 

TO 

36 

Cl. 

1*9) 

=C<2 

:) 

IF<I 

•  GE. 

55) 

60 

TO 

36 

F(I, 

1*10 

)=C< 

4) 

IF<I 

•  GE. 

51) 

GO 

TO 

36 

P  <1, 

1*14 

)=C< 

5) 

IF(I 

•  GE. 

50 

GO 

TO 

36 

PCI, 

I*15 

)=C< 

4) 

IFCI 

•  GE. 

49) 

GO 

TO 

36 

PCI, 

I*16 

)=C< 

3) 

IFCI 

•  GE. 

46) 

GO 

TO 

36 

PCI, 

1*17 

)=CC 

4) 

IFCI 

•  GE. 

47) 

GO 

TO 

36 

PCI. 

1*18 

)=CC 

5) 

CONT 

INUE 

00  37  1=1, M 
HC8*I-7,ti*I)=C^0 
F-  <8*1-7, R  •I-1)=0.0 
P (8*I-6,8*I )=G«0 
IF  fl.GE.a)  GO  TO  37 
R(e*I,8*I*l)=0^0 
RC8*I,a*I*2)=0^0 

Rca*i-i,a*i4i)=o.o 

R<8*I-7,8*I*7)=0^0 
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102 

5 

103 

1 

2 

ICO 

3 

ICI 

4 

6 


SUBROUTINE  DI SPLAY < iXSIZEt lYSIZE *  DAT  A > 
INTEGER  IXYC122) 

COMPLEX  DATA<IYSI2E*IXSIZEI 
liRITE(6«102} 

FORMAT  (IHll 
NUM=1XSIZE*2 
DO  5  1=1. NUM 
IXYCl )=1H- 

URITE(6fl03l  (IXYCl  )«I=1.NUM) 

FORMATCT4.122A11 

DMIV=1.E30 

DMAX=-1.E30 

DO  1  I=1.IXSI2E 

DC  1  J=1.IYSIZE 

0MAX=AMAX1 (DMAX.CABS(DATA(J.I >}> 

DMIN  =AM  INI  (C  MIN  .CABS ( DAT ACJ.I > >) 

DC  4  Jsl.IYSIZE 
DC  2  i=i.ixs:zE 
IXYd  >=1H 

X=(CABS(DATA(J«I  M-DMIN>/(DMAX-DMIN) 
IF(X.6T..42)  IXY<I)=1H0 

IF(CX.GT..23) •AND.(X.LT..42) >  IXY(I>=1HX 

IF  C(X.GT..14}.AND.(X.LT..2P))  IXY(I>=1H* 

CONTINUE 

NUM=IXSIZE*1 

IXY<NUM)=1HC 

WRITECSflOO)  (IXY(I)«X=1«NUM) 
F0RMAT<T4.*!*tl21Al) 

DO  3  m.IXSIZE 
IXYd  I=1H 

X=(CABS(DATACJ  .1 > )-DMIN>/(DMAX-DMIN) 
IF((X.GT..56>.AND.<X.LE..70> I  IXY(I)=1H- 
IF((X.GT«.70}.AND«(X.LE..B4) )  IXY(I>=1H* 
IF<X.GT.-84I  IXY(I)=1H«( 

CONTINUE 

VRITECe.lOl)  (IXYCl >.I=1«IXS1ZE> 
FORPAT(1H*.T5.120 A1 » 

CONTINUE 
NUR=IXSIZE*2 
DO  6  1=1. NUM 
IXYd  »=1H- 

NRITE(6.103)  (IXY(II.I=1.NUM) 

RETURN 
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SUBROUTINE  SHIFT<DATA»N*XSHIFTfYSHIFT» 

COMPLEX  DATA<N*N»tTEMPl*TEHP2fTEMP3#TEMP4,FXtFXCtFT*FYC 
C  THIS  ROUTINE  IMPLEMENTS  A  SPATIAL  PHASE  SHIFT 

C  IN  THE  FREQUENCY  DOMAIN.  THE  ARRAY  DATA  IS  ASSUMED  TO  BE  THE 

C  NXN  ARRAY  OF  FOURIER  TRANSFORM  COMPONENTS  AS  GENERATED  BY  THE 

C  TRANSFORM  ROUTINE  FCURT.  FOR  EXAMPLE*  FOR  A  6X6  ARRAY  DATA 

C 

C  - : - 

C  C  XO  YO  t  XI  TO  t  X2  YO  E  X3  YO  CX2*  YO  CXI*  YC  C 

c  - 

C  C  XO  Y1  C  XI  Y1  C  X2  Y1  C  X3  Y1  CX2*  Y1  CXl*  Y1  C 

C  - 

C  C  XO  Y2  C  XI  Y2  C  X3  Y2  C  X3  Y2  CX2*  Y2  CXl*  Y2  C 

C  - 

C  C  XO  Y3  C  XI  Y3  C  X2  Y3  C  X3  Y3  CX2*  Y3  CXl*  Y3  C 

C  - 

C  C  XO  Y2*C  XI  Y2*C  X2  Y2*C  X3  Y2*CX2*  Y2*CX1*  Y2*C 

C  - 

C  C  XO  Y1*C  XI  Y1*C  X2  Y1*C  X3  Y1*CX2*  Y1*CX1*  Y1*C 

C  - 

c 

C  PHASE  SHIFTING  IS  IMPLEMENTED  BY  MULTIPLYING  THE 

C  FOURIER  TRANSFORM  COMPONENTS  BY 

C  EXP  C J*2*PI CFX*  XSHIFT*FY*YSHIFT  >  > 

C 

C  XSHIFT  AND  YSHIFT  ARE  THE  SHIFTS  IN  THE  X  AND  Y  COORDINA’’E 

C  DIRECTIONS. 

C 

C 

7  PI =3.141592654 

OEM=FLOA^<N> 

NCENTsN/2*1 
DO  1  I=l*NCENT 
DO  I  J=1*NCENT 

FX=CMPLX(0.*-2.*PI*C J-1I*XSHIFT/DEM> 
FY=CMPLX<0.*-2.*PI*<I-1)*YSHIFT/DEM) 

FXC=CONdG(rx) 

FYC=CONdG<FYI 
TEMPl=OATA<I  «J) 

DATA<I*J»=TEMP1*CEXP<FX^FY) 

IF(I.EQ.l)  GO  70  10 

IF( J.EQ.l.OR.J.EQ.NCENT)  GO  TO  20 

TEMP2=DATA<I *n*2-J> 

TEMP3=DATACN*2-I*Jl 

TE»'P4=0ATA<N*2-I*N*2-J> 

DATA(I*N+2-d)=TEMP2*CEXPCFXC*FY> 

0ATA<N*2-I*J)=TEMP3*CEXPfFX*FYC> 

DATA(N*2-I*N*2-J)=TEMP4*CEXPCFXC*FYC> 

GO  TO  1 

1C  IF(d.EQ.1.0R .J.EQ.NCENT)  GO  TO  1 

TEMP2=DAT  Ad  *N*2-J» 

DATACI*N*2-d)=TEMP2*CEXP(FXC*FYI 
GO  TO  1 

20  TEMP3=DATA(N*2-I *J> 

DATAfN*2-I*J)=TEMP3*CEXP<FX*FYC) 

1  CONTINUE 

RETURN 
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:: 


K  50 


10 


55 


fl 


20 


SUBRuUTI^E  OEPIV(OATAtN«DX«DY} 

COMPLEX  DATA<N*MtTEHPltTEMP2fTEMP3tTEMP4,FXtFXC*FYtFYC 
COMPLEX  OX(NfM*DYCKtN> 

THIS  ROUTINE  IMPLEMENTS  SPATIAL  PARTIAL  DERIVATIVES 
IN  THE  FREQUENCY  DOMAIN.  THE  ARRAY  DATA  IS  ASSUMED  TO  BE  THE 
NXN  ARRAY  OF  FOURIER  TRANSFORM  COMPONENTS  AS  GENERATED  BY  THE 
TRANSFORM  ROUTINE  FOURT.  FOR  EXAMPLE#  FOR  A  6X6  ARRAY  DATA 


c 

xo 

YO  c 

XI 

YO 

C 

X2 

YO  t 

X3 

YO  CX2* 

YO  CXI* 

YO  C 

c 

xo 

Y1  C 

XI 

Y1 

c 

X2 

Y1  C 

X3 

Y1  CX2* 

Y1  CXI* 

Y1  C 

c 

xo 

Y2  C 

XI 

Y2 

c 

X3 

Y2  C 

X3 

Y2  CX2* 

Y2  CXI* 

Y2  C 

c 

xc 

Y3  E 

XI 

Y3 

t 

X2 

Y3  r 

X3 

Y3  CX2* 

Y3  CXI* 

Y3  C 

r 

xo 

Y2*C 

XI 

Y2*C 

X2 

Y2*t 

X3 

Y2*CX2* 

Y2*CX1* 

Y2*C 

c 

xo 

Y1*C 

XI 

Y1*C 

X2 

Yl*t 

X3 

Y1*CX2* 

Y1*CX1* 

Y1*C 

DIFFERENTIATION  IS  IMPLEMENTED  BY  MULTIPLYING  THE 
FOURIER  TRANSFORM  COMPONENTS  BY 

J*2*PI*FX  AND  J*2*PI*FY 


PI=3. 141592654 
DEM=FL0AT<N) 

NCENTsN/2+1 
DC  1  1=1#NCENT 
DO  1  J=lfNCENT 

FX=CMPLX<0.»*2.*PI*CJ-1)/DEM> 

FY=CMPLX<0.#*2.*PI*fI-l)/DEM> 

FXC=CONJG(FX) 

FYC=CONJG<FY) 

TEMP1=DAT A<I #JI 

DX<I #J>-TEMPl*FX 

0Y(I*J)=TEMP1*FY 

IF<I.EQ.1>  GO  TO  10 

IFCJ.EG. l.OF .J.EQ.NCENT)  GO  TO  2C 

TEMP2=DATA<I #N^2-dl 

TEMP3=0ATA<N*2-I tJ) 

TEMP4=0AT  A<N^2-I»N*2-J> 
DX(I#N*2-d)=TEMP2*FXC 
DY(I#N+2-d)=TEMP2*FY 
DXCN*2-I # J)=TEMP3*FX 
DY(N^2-I#d)=TEMP3*FYC 
DX(N*2-I fN*2-Jl=TEMP4*FxC 
0Y(N42-I  f  N'»2-J)=TEMP4*FYC 
GO  TO  1 

IFCJ.EQ. l.OR .J.EQ.NCENT)  60  TO  1 
TEMP2=DA7ACI#N*2-d> 
DX(I#N>2-J>=TEMP2*FXC 
DY(I #N^2-J)=TEMP2*FY 

GO  TO  1 

TEMP3=OA'-A<N^2-I  «J) 


501 
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DXIN+2-I , J)=TEHP3*FX 

DYCK+2-I f J»=TEPP3*FVC 

CONTINUE 

RETURN 

END 


60 


1 
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I 


5 


10 


15 


20 


25 


30 


35 


40 


45 


50 


55 


SUBROUTINE  FCU-T(DATAfNNfNOI Mf ISI 6N« IFORH«UCRK> 

C  FOR  INFORMATION  CONTACT  HR.  MARK  HALLER  4950 /ADD? 756246 

C 

C  the  COOLEY-TUKEY  fast  FOURIER  TRANSFORM  IN  USASI  BASIC  FORTRAN 

C 

C 

C  TPANSF0RM(Kl«K2f...  )  =  SUMf DAT A { J1 • J2 «.. • )*EXP( ISI6N*2*PI* SORT ( 

C  *((Jl-l)«(Kl-l)/NN(l)^Cd2>l)*(K2>l)/NNC2)«...>)>*  SUMMED  FOR  AL 

C  Jlf  K1  BETUEEN  1  AND  NNC1)«  J2«  K2  BETWEEN  1  AND  NNf2)t  ETC. 

C  THERE  IS  NO  LIMIT  TC  THE  NUMBER  OF  SUBSCRIPTS.  DATA  IS  A 

C  MULTIDIMENSIONAL  COMPLEX  ARRAY  WHOSE  REAL  AND  IMAGINARY 

C  FARTS  ARE  ADJACENT  IN  STORAGEt  SUCH  AS  FORTRAN  IV  PLACES  THEM. 

C  IF  ALL  IMAGINARY  PARTS  ARE  ZERO  (DATA  ARE  DISGUISED  REALIt  SET 

C  IFORM  TO  ZERO  TO  CUT  THE  RUNNING  TIME  BY  OP  TO  FORTY  PERCENT. 

C  OTHERWISE*  IFORM  =  ♦!.  THE  LENGTHS  OF  ALL  DIMENSIONS  ARE 

C  STORED  IN  ARRAY  NN.  OF  LENGTH  NDIM-  THEY  MAY  BE  ANY  POSITIVE 

C  integers*  THO  the  program  runs  faster  on  COMPOSITE  INTEGERS*  AN 

C  ESPECIALLY  FAST  ON  NUMBERS  RICH  IN  FACTORS  OF  TWO.  ISIGN  IS  ♦! 

C  OR  -1.  IF  A  -1  TRANSFORM  IS  FOLLOWED  BY  A  ♦!  ONE  COR  A  ♦! 

C  BY  A  -1)  THE  ORIGINAL  DATA  REAPPEAR*  MULTIPLIED  BY  NTOT  (=NN{1> 

C  NN(2 )*...)•  TRANSFORM  VALUES  ARE  ALWAYS  CCMPLEX*  IND  ARE  RETUR 

C  IN  ARRAY  DATA*  REPLACING  THE  INPUT.  IN  ADDITION*  IF  ALL 

C  DIMENSIONS  ARE  NOT  POWERS  OF  TWO*  ARRAY  WORK  MUST  BE  SUPPLIED* 

C  COMPLEX  OF  LENGTH  EQUAL  TO  THE  LARGEST  NON  2**K  DIMENSIOHU 

C  OTHERWISE*  REPLACE  WORK  BY  ZERO  IN  THE  CALLING  SEQUENCE. 

C  NORMAL  FORTRAN  DATA  ORDERING  IS  EXPECTED*  FIRST  SUBSCRIPT  VARYI 

C  FASTEST.  ALL  SUBSCRIPTS  BEGIN  AT  ONE. 

C 

C  RUNNING  TIME  IS  MUCH  SHORTER  THAN  THE  NAIVE  NT0T**2*  BEING 

C  GIVEN  BY  THE  FOLLOWING  FORMULA.  DECOMPOSE  NTCT  INTO 

C  2**K2  *  3**K3  *  5**K5  *  ....  LET  SUM2  =  2*K2*  SUMF  =  3*K3  ♦  5* 

C  ♦  ...  AND  NF  =  K3  ♦  K5  ♦  ....  THE  TIME  TAKEN  BY  A  MULTI- 

C  DIMENSIONAL  TRANSFORM  ON  THESE  NTOT  DATA  IS  T  =  TO  ♦  NTOT*CTl*> 

C  T2*SUM2*T3*SUMF*T4*NF>.  ON  THE  CDC  3300  CFLOATIN'G  POINT  ADD  TI 

C  CF  SIX  MICROSECONDS)*  T  =  3000  ♦  NTOT* C50 0443*SUM2*68*SUMF4 

C  320*rvF)  MICROSECONDS  ON  COMPLEX  DATA.  IN  ADDITION*  THE 

C  ACCURACY  IS  GREATLY  IMPROVED*  AS  THE  RMS  RELATIVE  ERROR  IS 

C  BOUNDED  BY  3 *2** < -B )*SUM<FACTOR ( J > *• 1 .5 ) *  WHERE  B  IS  THE  NUMBER 

C  OF  BITS  IN  THE  FLOATING  POINT  FRACTION  AND  FACTORCd)  APE  THE 

C  PRIME  FACTORS  OF  NTCT. 

C 

C  PROGRAM  BY  NORMAN  BRENNER  FROM  THE  BASIC  PROGRAM  BY  CHARLES 

C  RADER.  RALPH  ALTER  SUGGESTED  THE  IDEA  FOR  THE  DIGIT  REVERSAL. 

C  MIT  LINCOLN  LABORATORY*  AUGUST  1967.  THIS  IS  THE  FASTEST  AND  M 

C  VERSATILE  VERSION  OF  THE  FFT  KNOWN  TO  THE  AUTHOR.  SHORTER  PRC- 

C  GRAMS  FOURl  AND  F0UR2  RESTRICT  DIMENSION  LENGTHS  TO  POWERS  OF  T 

C  SEE—  IEEE  AUDIO  TRANSACTIONS  fJUNE  1967)*  SPECIAL  ISSUE  ON  FFT 

C 

C  THE  DISCRETE  FOURIER  TRANSFORM  PLACES  THREE  RESTRICTIONS  UPON  T 

C  DATA. 

C  1.  THE  NUMBER  OF  INPUT  DATA  AND  THE  NUMBER  OF  TRANSFORM  VALUES 

C  MUST  BE  THE  SAME. 

C  2.  BOTH  THE  INPUT  DATA  AND  THE  TRANSFORM  VALUES  MUST  REPRESENT 

C  EQUISPACED  POINTS  IN  THEIR  RESPECTIVE  DOMAINS  OF  TIME  AND 

C  FREQUENCY.  CALLING  THESE  SPACINGS  DELTAT  AND  DELTAF*  IT  MUST  I 

C  TRUE  THAT  DELTAF=2*PI /fNN{I)*DELTAT).  OF  COURSE*  DELTAT  NEED  ) 

C  BE  THE  SAME  FOR  EVERY  DIMENSION. 
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C  3.  CONCEPTUALLY  AT  LEASTf  THE  INPUT  DATA  AND  THE  TRANSFORM  OUTP 

C  REPRESENT  SINGLE  CYCLES  OF  PERIODIC  FUNCTIONS. 

C 

C  EXAMPLE  1.  THREE-DIMENSIONAL  FORWARD  FOURIER  TRANSFORM  OF  A 

C  COMPLEX  ARRAY  DIMENSIONED  32  BY  25  BY  13  IN  FCRTRAN  IV. 

C  DIMENSION  DATAC32t25«13)»U0RKC50 >«NNC3) 

C  COMPLEX  DATA 

C  DATA  NN/32«25«13/ 

C  DO  1  1=1,32 

C  DO  1  J=l,25 

C  DO  1  K=l,13 

C  1  DATA(l,d,K)=COMPLEX  VALUE 
C  CALL  FOURT<DATA,NN, 3,-1, 1, WORK) 

C 

C  EXAMPLE  2.  CNE-DIMENSICNAL  FORWARD  TRANSFORM  OF  A  PEAL  ARRAY  01 

C  LENGTH  64  IN  FORTRAN  II. 

C  DIMENSION  DATA(2,64> 

C  DC  2  1=1,64 

C  0ATA(1,I )=REAL  PART 

C  2  DATA(2,I)=0. 

C  CALL  F0URT<DATA,64,1,-1,C,C ) 


DIMENSION  OATACl ) ,NN f 1 > «IFACTf 32 ) , WORKCl ) 

CDC  6600  INITIALIZATION 

URITE(6,90GG) 

WR=0. 

WI=C. 

WSTPR=0. 

WSTPI=0. 

TWOPI  =  6.283165307 
IF<NDIM-l)920,l,l 
NTCT=2 

DO  2  IDIM=l,NOIM 
IF(NN<IDIM) >920,920 ,2 
NT0T=NT0T*NN<IDIM) 

MAIN  LOOP  FO-  EACH  DIMENSION 

NP1=2 

DO  910  IOIM=l,NOIM 
N=NN(IDIM) 

NP2=NP1*N 
IF(N-1>920,90C  ,5 

FACTOR  N 

M=N 

NTWC=NP1 

■rF=i 

IOIV=2 

IQUOT=M/IDIV 

IPEM=M-IDIV*IQtOT 

IFdOUOT-IDIV  >50,11, 11 

IF<IREM>20,12,20 

NTMO=NTWO*NTWO 

M=10U0T 

60  TO  10 
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:« 


::>15 

Pli 


hv.25 


?.30 


:35 


••L4C 

M  C 


I  'A  45 


•:;i  50 


155 


« 

hnto 


2C 

30 


31 

32 


40 

50 

51 


60 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

70 


71 

72 

73 

74 


IDIV=3 

IQLOT=M/IDIV 

IREM=H-IDIV*IQUO'' 

IFfIQUOT-IOIVJ60  *31*31 

IFCIF  EP)4C*32*40 

IFACT(IF1=I0IV 

IF=1F*1 

F=I01J0T 

GO  TO  30 

IOIV=IOI  V^2 

GO  TG  30 

IFIIREM)60*51*60 
NTWO=NTWO+NTkO 
GO  TO  70 
IFACT(IF)=M 

SEPARATE  FOUR  CASES— 

1.  COMPLEX  TRANSFORM  OR  REAL  TRANSFORM  FOR  THE  4TH*  5TH»ETC. 

dimensions. 

2*  REAL  TRANSFORM  FOR  THE  2ND  OR  3RD  DIMENSION.  METHOD — 
TRANSFORM  HALF  THE  DATA*  SUPPLYING  THE  OTHER  HALF  BY  CON¬ 
JUGATE  SYMMETRY. 

3.  REAL  TRANSFORM  FOR  THE  1ST  DIMENSION*  N  COD.  ME'^HOD— 

TRANSFORM  HALF  THE  DATA  AT  EACH  STAGE*  SUPPLYING  THE  OTHER 
HALF  BY  CONJUGATE  SYMMETRY. 

4.  REAL  TRANSFORM  FOP.  THE  1ST  DIMENSION*  N  EVEN.  METHOD- 
TRANSFORM  A  COMPLEX  ARRAY  OF  LENGTH  N/2  WHOSE  REAL  PARTS 
ARE  THE  EVEN  NUMBERED  REAL  VALUES  AND  WHOSE  IMAGINARY  PARt 
ARE  the  ODD  NUMBERED  REAL  VALUES.  SEPARATE  AND  SUPPLY 
the  SECOND  HALF  BY  CONJUGATE  SYMMETRY. 

N0N2=NP1 *CNP2/NTU0> 

ICASE=1 

IF(IDIM-4l71*90*g0 

IF<IFORM)72*72*90 

ICASE=2 

IF(IDIM-1>73*73*S0 

ICASE=3 

IF<N'TU0-NP1 190*90  *74 

ICASE=4 

NTliO=NTUC/2 

N=N/2 

NP2=NP2/2 

NT0T=NT0T/2 

1  =  3 

DC  80  J=2*NT0T 
DATA<J)=DATACI) 


65 


170 


(-0 

90 

«5 

C 

c 

c 

c 

lor 

lie 


I  =  I^2 
I1RNG=NP1 

IF( I CASE-2)10 0*95*100 
URNG=NP0*Cl*NPREV/2) 

SHUFFLE  ON  THE  FACTORS  OF  TWO  IN  N.  AS  THE  SHLTFLING 

CAN  BE  DONE  BY  SIMPLE  INTERCHANGE*  NO  WORKING  ARRAY  IS  NEEDED 

IFiNTWO-NPl 1600*600 *110 
NP2HF=NP2/2 
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J=1 

DO  150  12 

IFC J-I2)l 

I1KAX=I2+ 

DO  125  II 

DO  125  13 

J3=J+I3-1 

TE^PP=DAT 

TEFPI=DAT 

DATA(131= 

DATA(I3+1 

DATA<J3)= 

CATA(J3+1 

K=NP2HF 

IFCJ-?*)15 

J=J-M 

P=M/2 

IF<M-fJ0N2 

JrJ+y 


=  l«NP2«fiCN2 
2Ctl30«130 
N0N2-2 
=I2*I1KAX«2 
=11  *M0TtNP2 
2 

A  (I  3) 

ACI3+1> 

DATA( J3> 
)=OATAC J3+l> 
TEKPP 
»=TEPPI 

0«150  •145 


}150«140tl4C 


MAIN  LOOP  FOR  FACTORS  OF  TWO.  PERFORM  FOURIER  TRANSFORMS  OF 
LENGTH  FOUR*  WITH  ONE  OF  LENGTH  TWO  IF  NEEDED*  THE  TWIDDLE  FA 
W=EXP<ISIGN*2*PI*SQRTC-1)*M/C4*MMAX)).  CHECK  FOR  W=ISIGN*SQRT 
AND  REPEAT  FCR  W=ISI6N*SQRTf-l >*C0NJU6ATEfU> • 


NON2T=NON2+NON2 

IPAR=NTW0/NP1 

IF(IPAP-2)35Q*330*320 

IPAR=IPAP/4 

GO  TO  310 

DO  340  I1=1*I1RNG*2 
DC  340  J3=I1 *N0N2*NP1 
DC  340  K1=J3*NT0T,NCN2T 
K2=K1+N0N2 
TEMPR=DATA<K2) 

TERPI=DATA<K2+1) 
DATA<K2>=DATA<K1>-TEMPP 
DATA(K2+1>=DATA<K1+1I-TEMPI 
DATA(K1)=DATACK1 )+TEHPR 
DATACKl+1 )=0ATA<K1+1»+TEMPI 
MMAX=N0N2 

IF CMMAX-NP2HF) 370 *600*600 
LMAX=MAX0  CN0N2T*MMAX/2) 

IF CMMAX-NCN2 1405*405*380 

THETA=-TW0PI«FLCATCN0N21/FL0AT<4*MMAX) 

IFCISIGM400*39C  *390 

THETAs-THETA 

UR=C0S<THETA> 

UI=SINCTHETA) 

fcSTPR=-2.*Wl*WI 

WSTPI=2.*WR* WI 

DO  570  L=N0N2*LMAX*N0N2T 

M=L 

IF CMMAX-N0N2 1420  *420*410 
W2R  =  WR*UR-UI’*WI 
li2I  =  2.*WR*WI 
U3R=U2R*WR-W2I*WX 
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U3I=U2R*UI«U2I*WR 

DO  530  Il=lfIlPNGt2 

DO  530  J3=I1 fN0N2>Kri 

KMIN=J3+IPAR*M 

IF(KPAX-NON2>43C«43Ct440 

KFIN=J3 

KDIF=IPAF*MMAX 

KSTEP=4*KDIF 

DO  520  Kl=KMlNtNTOTtKSTEP 

K2=K1»KD1F 

K3=K2*K0IF 

K4=K3^K0IF 

IF<HMAX>NCN2M60  «460t460 
U1R=DATA(K1}*0ATA{K2> 
U1I=:DATA(K1-»1  )♦0ATA<K2•*•1} 
U2R=0ATA<K3}-»0ATACK4I 
U2I=DATA<K3*1I^DATA<K4^1> 
U3R=DATA(K1 )-DATA(K2> 
U3I=OATA(Kl*l)-DATA<K2-H  > 

IF  Cl  SI  GM  470  *475.475 

U4R=DATA<K3*ll-OATACK4^1» 

U4I=0ATA(K4)-0ATA(K3} 

GO  TC  510 

U4R=DATACK4*1 )-OATACK3^1> 
U4I=0ATACK31-DATAIK4> 

GO  TO  510 

T2R  =  y2R*0ATA<K2)-U2I*0ATA{K2<i-l) 

T2I=W2R*0ATA<K2^1)>U2I*DATA(K2) 

T3R=UR*0ATACK3I-UI*0ATACK3^1> 

T3I=UR*DATACK3-*1  It-UI^DATAC K3  ) 

T4R  =  W3R*DATACK4)-W3I*OA’’ACK4*l  ) 

T4I=U3R*0ATA<K4+1 >♦W3I*DATAC K4> 

U1R=DATA<K1>*T2F 

U1I=DATA<K1*1)*T2I 

U2R=T3R*T4R 

U2I=T3I*T4I 

U3R=OATA<Kl»-T2R 

U3I=DATA(K1*1»-T2I 

IFCISIGM490  .500  .50C 

U4R  =  ‘^3I-T4I 

U4I=T4P-T3R 

GO  TO  510 

U4R=T4I-T3I 

U4I=T3R-^4R 

DATA<K1)=U1R^U2R 

DATA! Kl^l ):U1I«U2I 

0ATA(K2)=U3R^U4R 

0ATA<K2*1)=U3I^U4I 

0ATACK3)=U1R-U2P 

DATA(K3*1 )=U1I-U2I 

0ATAfK4»=U3R-U4R 

0ATACK4*! I=U3I-U4I 

KMIM=4*<KFIN-d3I>J3 

KOIFsKSTEP 

KD1F  =  KSTEP 

IFCKOIF-NP2)450.530f530 

COKTINUL 
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•305 

ja 


/310 

i  CE 

•  I 

;515 

i 

r--5  20 


k 

H25 


540 


55  C 


560 

565 

57C 


C 

C 

C 

C 

C 

c 

600 
•  6C5 


610 


611 


612 

615 


62C 

625 


3  35 

N 


r- 


63  C 

635 

640 


FsfFAX-H 

IF C 1 SIGN ) 540 f 550 t 550 

TEMPRsWR 

liR=-UI 

WIs-TEMPF 

GO  TO  560 

TEFPfisUR 

yR^UI 

UI=TEHP? 

IFCR-LMAX  >565«565«410 
TEHPP=UR 

WR=UR*USTPR-UI*USTPI-»UR 
NI=WI*USTPR*TEFPR*USTPI^WI 
I PAR =3-1  PAR 
PMAX=MHAX«>MBAX 
GC  TO  360 

MAIN  LOOP  FOR  FACTORS  NOT  EQUAL  TO  TWO.  APPLY  THE  TUIOOLE  FACT 
k=EXP(ISIGN*2*PI*SQRTC-l>*f J2-1)*(J1-J2>/(NP2*IFP1 )>«  THEN 
PERFORM  A  FOURIER  TRANSFORM  OF  LENGTH  IFACTCIFI*  MAKING  USE  OF 
CONJUGATE  SYMMETRIES. 

IFCNTHO-NP2»605*700t700 

IFP1=N0N2 

IF=1 

NPlHF=NPl/2 

IFP2=IFP1/IFACT(IF1 

J1RNG=NP2 

lF(ICASE-3)612f611«612 

JlRNG=<NP2*IFPll/2 

J2STP=NP2/IFACTCIFI 

JlRG2=<J2STP>IFP2l/2 

J2MIN=1*IFP2 

IF(IFPl-NP2)615t640f640 

DO  635  J2=J2MINfIFPl,IFP2 

THET A=-T UOPI*FLO AT <J2-1> /FLOAT CNP2> 

IFCISI6N)625«620f620 

THETA=-THETA 

SINTH=SINCTHETA/2.» 

WSTPR=-2.*SINTH*SINTH 

kSTPI=SIN<TMETAl 

UR=WSTPR'»1. 

yi=USTPI 

J1  MIN=*.2^IFP1 

DO  635  J1=J1MIN» JlRNGflFPl 
IlMAX=Jl*IlRNG-2 
CO  630  Il=JltIlMAXf2 
DO  630  I3=IltNTQT«NP2 

J3MAX=I3+IFP2-NP1  i 

DO  630  J3=I3f J3MAXtNPl 
TEMPR=DATA( J3> 

0ATA(J3>=0ATA(J3)*yR-DATAf J3«l )*UI 
DATACJ3*!  )=TEMPR*UI<»OATAfJ3»l)*yR 
TEMPRsyR 

yR=UR*ySTPR-yi*WSTPI-»«R 

yi=TEMPR*ySTPI+MI»HSTPR*UI 

THETAs-THOPI/FLOATCXFACTIIF)> 
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145 


;-350 

I 

:355 


^60 


•365 


■) 


l37a<S 


P 


75 


-3?  5 


•395 


IF<ISIGN)650  «645«645 
645  THETA=-THETA 
650  SINTH=SIN(THETA/2*  ) 

WSTPR=-2.*SINTH*SINTH 

USTPI=SIN«THETA» 

KSTEP=2*N/IFACT<IF> 

Kf<ANG=KSTEP*CIFACT<IFI/2>^l 

00  698  Il=ltIlRNGt2 

DO  698  I3=I1*NT0T*NP2 

CO  690  KBIN=ltKRAN6tKSTEP 

J^«AX=I3•^J1RNG-IFP1 

00  680  J1=:I3«J1MAX»IFP1 

J3PAX=»J1->IFP2-NP1 

00  680  J3=J1 «J3HAXtNPl 

d2PAX=d3->IFPl-IFP2 

K=KPIN-*Cd3-dl-Kdl-I3l/IFACTfIF))/NPlHF 
IF<KHIN-1 )655t655*665 
655  SUPP.sO. 

SUM-0. 

00  660  d2=d3td2HAXtIFP2 
SUMR=SUMP.*0ATA(d2) 

660  SUFI  =  SUMI-»DATAfd2-»l  > 

UORK(K)=SUBR 
Vi0RK(K-»l  IsSUHI 
GO  TO  66  0 

665  KC0Nd=K-»2*<N-KPIN*l  > 
d2=d2HAX 
SURR=DATA<d2I 
SUPI=DATACd2*ll 
CLOSR=0. 

CLOSI=0. 
d2=d2-IFP2 
67C  TEMPRrSUFR 
TEPPI=SUHI 

SUMR=TU0UR*SUMR-0L0SR-»DATA(d2) 

SU«I=TUOUR*SUBI-OLOSI^OATA«d2*l ) 

CLOSR=TEMPR 

CLDSI=TEMPI 

d2=d2-IFP2 

IFCd2-d3»675t675f670 
675  TEPPR=MR*SUMP-0LDSR‘»DATACd2» 
TEPPI=WI*SUPI 
liOPK(K)=TEHPR-TEMPI 
VIORK<KCONd»  =  TEKPR->TCWPI 
TEMPR  =  UR*SUMI-0LDSI^DATACd2-H) 
TEPPIsUI^SLRR 
W0RK(K*1 )=TE«PR*TEMPI 
W0PK<KC0Nd*l l=TEMPR-TEHPI 
68C  CONTINUE 

IFfKPIN'l >685«6H5t686 

685  WRiUSTPR-M. 
liI  =  WSTPI 

60  TO  690 

686  TEHPR=WR 

tiR  =  UR*USTPR-UI*USTPI*UR 
WI=TEMPR*USTPI-»UI«MSTPR^MI 
69C  TWOUR=WR«UR 
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IF(ICASE>3)692f691«692 

IFCIFPl-KP2>695t692»692< 

K=1 

I2FAX=I3*NP2-NP1 

DO  693  I2=I3*I2MAXtNPl 

0ATA(I2)=U0RK(K> 

OATA(I2«l }=UCRKf K«l) 

K=K-*’2 
60  TC  696 

COMPLETE  A  REAL  TRANSFORM.  IN  THE  1ST  DIMENSIOKf  N  CDD«  BY  CON¬ 
JUGATE  SYMMETRIES  AT  EACH  STAGE. 

J3MAX=I3-»IFP2-NP1 
DO  697  J3=:13»J3MAXtNPl 
J2RAX=  J3^NP2-d2STP 
DC  697  J2=J3«J2MAXt J2STP 
JlMAXrJ2-»JlRG2-IFP2 
J1CNJ=J3-»J2MAX+J2STP-J2 
DO  697  Jl=J2«JlMAXtIFP2 
K=1*J1-13  ♦ 

DATA(Jll=yORKCKI 

DATACJl-ollsUCRKCK+l) 

IF(Jl-d2l697«697«696 
DATA<JlCNJ)=yORKf K> 

OATAf  J1CNJ^1I=-U0RKCK-»1> 

JlCNdsJlCNJ-IFP2 

CONTINUE 

IF=IF*1 

IFP1=IFP2 

IFCIFPl-NP11700f700»610 

complete  a  real  TRANSFORM  IN  THE  1ST  DIMENSIONt  N  EVEN*  BY  CON 
JUGATE  SYMMETRIES. 

GO  TO  <900*  800*  900*  70l>  ICASE 
NHALF=N 

THET A=-T yOPI /FLO AT < M 

IF<ISlGNI703f702«702 

THETA=-THETA 

SINTH=SINCTHETA/2. > 

ySTPR=-2.*SINTH»SINTH 

USTPI=SIN<THETA) 

yRsySTPR^l. 

fcIsWSTPl 

IMIN=3 

JMIN=2*NHALF-1 
GO  TO  725 
J=JMIN 

DO  720  1=IMIN*NT0T*NP2 
SUMR  =  (OATA<I  )<»0ATA(  J)  1/2. 

SUMI=<DATACI+l)^DATACJ*l>)/2. 

0IFP=<0ATA<II-0A7A< J|}/2. 

DIFIr|OATACI^l>-OATA<J*ll)/2. 

TEMPR=yR*SUMI^yi«DIFR 

TEMPI=UI*SUMI-yR*OIFR 

510  I 
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OATA<I>=SUMR-»TEMPR 
OA7A(I+l >=DIFI*TEMPI 
DATA<J>=SUMP-TEMPR 
OATA<J*l l=-DrFI+TEMPI 
720  J=J*NP2 

IMIN=IFIN^2 
dMIN=JPIK-2 
TEMPR  =  UR 

UR=UR*USTPR-UI*USTPI^UR 
WI=TEMPR*ySTPI^UI*«STPR^WI 
725  IFCIMIN-dMIN)710*730*740 

730  IF<ISIGNI731*740t740 

731  DO  735  I=IMIN*NT0T*KP2 
735  DATA<I*1 »=-OATA<I*l) 

740  NP2=NP2+NP2 

NTOT=NTOT^NTOT 
d=NTOT*l 
IMAX=NT0T/2^1 
745  IHIN=IMAX-2*NHALF 
I=IHIN 
GO  TO  755 

75C  OATA<J}-DATA<I 1 

DATAIJ*! »=-DA7A(I^l > 

755  I=I+2 

J=J-2 

IF ( I -I  MAX  1 750 t760 tTGO 
760  OATA<J)=DATA<IMIN)-DATAfIMIN'+l  > 

0ATA(J«1)=0« 

IF(I-d>770*780»760 
765  DATA(J)=OATA(l> 

OATA<J«l )=OATA(I«l> 

770  1=1-2 

J=J-2 

IF<I-IMIN»775t775*765 
775  OATACJ)=DATA<IMIN»*DATAf IMIN*1> 

OATA(J«l )=0. 

INAX=IMIN 
GO  TO  745 

760  0ATACl>=0ATACl}*0ATAf2l 
0ATA<2>=C. 

GO  TO  900 
C 

C  COMPLETE  A  REAL  TRANSFORM  FOR  THE  2ND  OR  3RO  DIMENSION  BT 

C  CONJUGATE  SYMMETRIES. 

C 

eOC  IF(IlRNG-NPl)805t90Ct900 
805  DO  860  I3=l*NTOTfNP2 
I2MAX=I3+NP2-NP1 
DO  860  12=I3fI2MAXfNPl 
IMIN=I2^I1RNG 
IMAX=I 2+NP1-2 
JMAX=2*I3^NP1-IMIN 
IF(I2-I3>a20«820  tSlO 
810  JMAX=JMAX<»NP2 
820  IFCIDIM-2)850«e50t830 

830  J=JMAX^NP0 

DO  840  I  =  IMIN«lMAXf2 

511 
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i:-520 


OATAd  )  =  DATA(J) 

DATAdd  )=-OATA(  J4>1} 

840  J=J-2 

esc  J=JFAX 

00  6£>0  I  =  IMINtIHAX«NPQ 
CATAd  >=DATA(J) 

DATACm  )=-OATACJ^l> 
eec  j=j-NPo 

c 

C  END  OF  LOOP  Oft  EACH  DIHEKSION 

C 

900  NPO=ftPl 
ftPl=NP2 
910  ftPREW=N 
92C  RETURN 
END 


*  * 

^R.  SEVERITY  DETAILS 

i'4  95  I  data 

:>496  I  DATA 


DIAGNOSIS  OF  PFOBLEM 

ARRAY  REFERENCE  OUTSIDE  DIMENSION 
ARRAY  REFERENCE  OUTSIDE  DIMENSION 


BOUNDS. 

BOUNDS. 


onoooonoo 


SUBROUTINE  GAUSS 
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I  .  SUBROUTINE  GAUSS C I AtlY tVAL > 

THIS  ROUTINE  CALCULATES  A  GAUSSIAN  DISTRIBUTED  RANDCH  VARIABLE 
VALt  WITH  MEAK=0.  AND  STANDARD  DEVIATION^!. 

lA  IS  INITIALIZED  BEFORE  FIRST  CALL  TO  ANY  ODD  INTEGER  LESS  THI 
10  DIGITS  IK  LENGTH. 

lY  IS  GENERATED  AND  SHOULD  BE  USED  FOR  lA  CN  THE  NEXT  CALL  TO 
THIS  ROUTINE. 

VAL^C. 

DO  1  1=1 tl2 
X=RANF(OUN) 

IA=IY 

15  VAL=VAL*X 

1  CONTINUE 

VAL=VAL-6. 

RETURN 

END 


SUB»OUTIKE  INVERT 
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Si 


P  25 

I  <£ 


•:  30 


3[ 


40 


S  45 


50 

rr 

■>: 

55 


SUBROUTINE  INVERTC A*N*B#IER > 
IMPLICIT  REAL  <A-H,0-Z> 

OIPENSION  A(1)«B(1> 

PEAL  Lfl2B}tMfl28) 

NSQ=N*N 

DO  1000  I=1«NSQ 
loop  BCI)=A(!} 

D=1.G 

NK=-f, 

DO  ac  K=1»N 

NK=NK*N 

LCK)=K 

MfK»=K 

KK=NK*K 

BI6A=ACKK} 

DO  20  J=KtN 
IZ=fi*CJ-l) 

DO  20  I=KtN 
IJ=IZ*I 

10  IF(ABS(BIGA)-ABS<AC1J)>)  15f20»20 

15  BIGA=A(IJ> 

L(K1=I 

«(KJ=J 

20  CONTINUE 

d=L<Kl 

IF<J-K)  3St35*25 
25  KI=K-N 

BO  30  lsl«N 

KI=KI*N 

HOLD=-A<KI) 

JI=KI-K^J 

ACKI)=A(JI> 

30  A(OI)=HOLO 

35  I=M<KI 

IF<I-K)  45«45»38 
38  JP=N*<I-1J 

DO  40  J=1«N 
JK=NK<»«J 
JI=JP^J 
HOLD=-A( JKI 
ACJKMACJIl 
40  AfJIlsHOLO 

45  IFCBI6AI  .4e«46f4e 

46  0=0.3 
IEP=129 
GO  TC  150 

48  DO  55  1=1 *N 

IF(I-K)  50f55t50 
50  IKsrK^I 

A(IK)=A( IK)/C-BI6A) 

55  CONTINUE 

DO  65  I=1*N 
IK=\K»I 
IJ=I“N 
DO  65  J=1*N 
IJ=I J^N 

IF<I-K)  60f65fG0 
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a 


£0  IFfJ-K>  62«65t62 

£2  KJ=IJ-I*K 

A(IJ>=A(IK)*A(KJ)«A(IJ> 
65  CONTINUE 

KJ=K-N 
DO  75  J=1*N 
KJ=KJ«N 

IFCd-K)  70#75«70 
7G  A(KJ)=A(KJ)/BI6A 

75  CONTINUE 

0=D«BI6A 
A(KK1=1.0/BI6A 
eO  CONTINUE 

K=N 

100  K=<K-1> 

IFCKl  150tl5Ctl05 

105  I=LCK> 

IF(I-K)  120«120fl08 

106  dQ=N*(K-l) 
dR=N*<I-l  I 
DO  110  J=1«N 
JK=JQ«J 
HOLO-A<JK) 
dI=JF*J 
A(JK)x-A<JI> 

lie  ACdllsHOLO 

12C  J=«<K> 

IF(d-K)  100tl00tl25 
125  KI=K-N 

DO  130  I=ltN 
KI=KI^N 
HOLO=A(KI  ) 

JI=KI-K*d 

A(KI)=-A(J1} 

130  A(JI)=HOLO 

GO  TO  100 

15C  00  1002  I=ltNSO 

SAVE=ACI I 
ACI)=B<I  } 

B(I>=SAVE 
IOC  2  CONTINUE 

RETURN 


SUBROUTINE  MULT 
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1  SUBROUTINE  MULTI A,B*L#M*N,C» 

real  A(LtM)«BtMtN)«CCL«N) 

DO  300  I=ItL 
00  200  J=1«N 

5  CCIfJ)=0. 

00  100  iNOEXrlfM 

CCIf  J)=C(It  J>*A(I«lKOEX>*BCIfJOEXf  Jl 
IOC  CONTINUE 
200  CONTINUE 
10  300  CONTINUE 

RETURN 

END 


e 
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5 


3 


5 


a 


SUBROUTINE  CHOLYCAtKvS) 

C 

C  THIS  ROUTINE  DETERMINES  THE  LONER  TRIANGULAR  CHOLESKY  SQUARE- 

C  ROOT  OF  AN  NXN  MATRIX. 

C  A  IS  THE  INPUT  MATRIX  AND  S  IS  THE  CHOLESKY  SQUARE-ROOT  MATRIX 

C 

DIMENSION  ACNtN)«SCN*N) 

DO  120  I=1«N 
DO  120  J=1«N 
12r  SfltJI^Q. 

DC  123  I=1*N 
DO  123  J=1«N 

IF(ABSCA(I*J)).GT.l.E-06}  GO  TO  124 

123  CONTINUE 
RETURN 

124  Sfltl )rSQRT(A<ltl >) 

DO  5  I=2#N 
IM1=I-1 

DO  3  J=1«IM1 
JM1=J-1 
SU»<  =  0. 

DO  2  K=1,JM1 

2  SUM-SUM«S(IfK}*SCJ«K} 

3  S(It J)s<A(I« J)-SUM)/S(JtJ> 

SUM=0. 

DO  4  K=1*IM1 

4  SUM=SUH+SCItK)**2 

5  S<IfI)=SQ^lT<A<ItI>-SUM» 

RETURN 

END 


517 


SUBKOUTINE  ppim 
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SUB9CUTIKE  PRINT<A»NP*NC»MAME> 
OIHENSIOK  A(KR«NC> 

C 

C  THIS  ROUTINE  PRINTS  CUT  MATRICIES 

C 

1  F0RHAT(lXt//t2X«A15t*  MATRIX*#/} 

WRITE  <6*11  NAME 
DO  1C  I=lfN^ 

WRITE  (StS}  CACItJIt  J=l*r]C> 

5  F0PMAT(lXfR(F14.5tlX> ) 

1C  CONTINUE 

RETURN 
E\0 


I  o 

I  • 

«• 
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SUBROUTINE  FILTER CTOF«VARDFt T AF* VARAFtDT« PHIFtQFOtQFOHAX tQFDMI 
PEAL  PHIF(8«6} «QF0(e«e),QFDMAXCe>t0F0NINC8> 


THIS  ROUTINE  SETS  UP  THE  STATE  TRANSITION  MATRIX  AND  QFD  PATRI 


TAF  CORRELATION  TIME  FOR  THE  ATMOSPHERIC  JITTER 

TOP  CORRELATION  TIME  FCR  THE  TARGET  DYNAMICS 

VAROF  TARGET  DYNAMICS  NCISE  VARIANCE 
VARAF  ATMOSPHERIC  NCISE  VARIANCE 

THE  SOLUTION  TO  THE  DYNAMIC  EQUATIONS 


XFCI^l l=PHIF*XF<I  > 


FOR  PROPAGATION  OF  CCVARIANCE  MATRIX  NEED  QFD 


EX=EXP  <-DT/TOFI 

EX2=EX*EX 

FACT=1«-EX 

TD2=TDF*TDF 

TD3=TDF*T02 

T04=T0F*T03 

TDFDT=TDF*0^ 

DT2=OT*D7 

DT3=DT*DT2 

ZERO  ALL  MATRICIES 

DC  1  I=l«8 
DO  1  J=lt8 
PHIFilf J>=0. 

OFD(ItJ)=0. 

DETERMINE  PORTION  OF  PHI  MATRIX  THAT  REMAINS  CONSTANT 

^HlFn*l>=l. 

PHIFflf3)=DT 

PHIFIlt5)=*5*OT2 

PHIF(2»2I=1. 

PHIF<2f4>=DT 

PHlFf2f6)=PHIF<lf5) 

PHIF<3f3)=l. 

PHIFC3f5)=DT 

rHIFf4t4)=:l. 

PHIF(4»6l=PHIF(3fS> 

FHIFC7f7)=EXPC-OT/TAFj 

PHIFC8*8>=PHlFC7t7I 


FILL  IN  MAX  QFD  VALUES  FOR  QFD  ESTIMATION. 


QFOMAXCl )sQF0MAXC2)=2, 


SUBROUTINE  FILTER 
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10? 


GF0MAXC3)=QF0MAX(4)=15. 

GF0FAX(5)=QFDPAXC6)=25. 

GFDHAXC7>=QFOMAXC8>=O.S 

C 

C  FILL  IN  MIN  QFC  VALUES  FOR  QFD  ESTIMATION. 

C 

GFOMINCl )=QFOMIN(2I=0.1 
GFDMIN(3)=QF0MINC4>=0.3 
GFDMINC5)=GFOMIN<6>=3.0 
GFOM1N(7)=OFOMINC6>-O.031 
C 

C  IF  DESIRE  QFO  THAT  IS  THE  SAME  AS  THE  6AUSS-MARKOV  MODEL  THEN 

C  COMMENT  THE  NEXT  STATEMENT 

€C  TO  lOG 
C 

c 

c 

QFDU*ll=WARDF*<T04*2.*€T03*DT-TD2*DT2*TDF*DT3/3.) 

X  -TD3*EX*<4.*DT^TDF*EXn 

GFDCl •3»=VAR0F*CT03*C1.-2.*EX^EX2)-2.*TD2*DT*FACT*TDF«DT2I 
0FD<l,5)=VARDF*<TO2*<l.-EX2»-2.*TOFDT*EX> 

GF0(2f2)=GF0(lfll) 

0F0(2t4)>QFD<l«3) 

QF0{2f6}=QF0Clt5} 

0FD<3#l>  =  0FD(lf3) 

QFD<3*3)=VAR0F*<TD2*C4.*EX-EX2-3. >♦2.*TDFDT1 

OFO<3t5I=VAROF*TDF*FACT*FACT 

0F0<4,2)=QF0<2f4} 

QFO<4t4)=QFO(3«3} 

QF0C4t6)=QF0<3«5) 

GF0C5«ll-0F0(lt5} 

QF0fSt3)=QFD(3t5) 

GF0f6f21=QFD(2«6l 
9FD<6t4}=aF0(4«6) 
lOU  CONTINUE 

QF0C5»5)=VAR0F*<1.-EX2I 

QF0(6f6)-QFD<Sf5) 

QF0<7t7)=VARAF«<l.-EXPC-2.*DT/TAF)> 

0F0(8«8)  =  0F0(7«7) 

C 

C 

RETURN 

END 


K 

NR.  SEVERITY  DETAILS  DIAGNOSIS  OF  PROBLEM 
:  75  I  THERE  IS  NO  PATH  TO  THIS  STATEMENT. 
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0 


I 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 


c 


1 

c 


SUBROUTINE  PROPFf NR«NS*PHlF*QFDtPFPtPFMf XFPf XFPfTEMP2tNANIND) 
REAL  PHIF(6t6)«QFOCet6)tPFPCe«e>tPFMC8«8)fXFP(8>«)(FF<8> 

REAL  TEMPl(e«8>«TEMP2Ce*8>«PHlFTCef8l 


THIS  ROUTINE  IMPLEMENTS  THE  STATE  TRANSITION 
-EQUATIONS  FOR  THE  FILTER 


XFMCI^1>=PHIF*XFP<I  ) 


PFM=PHIF*PFP*PHIFT  ♦OFO 


WHERE  PHIF=FILTER  STATE  TRANSITION  MATRIX 

XF  =FILTER  STATE  VECTOR 
PFM  =COV  FILTER  STATES  MINUS 
PFP  =COV  FILTER  STATES  PLUS 


PERFORM  FILTER  STATE  PROPAGATION 


FIRST  DETERMINE  THE  CHANGES  IN  THE  PHI  MATRIX 


OT=1*/30. 

DT2=0T*DT 

A1=XFP<3I*»2*XFP<4>**2 

A2=XFP<3>*XFP<6)-XFP<4>*XFP(5» 

0MEGA=A2/A1 

UA1=0MEGA/A1 

PHIF<5t3l=-0T*UAl*CA2^2**XFPC3)*(XFPC6>-2.*0MEGA»XFPf3)l > 
PHIF<5*4»=2-*DT#WA1*XFPI3)*<XFPC5»^2.*XFPC4»*0ME6A> 
PHIF<5*5l=1.^2**DT*liAl*XFPC3)*XFPC4> 
PHIF(5t6)=-2,*0T*WAl*XFPl3>*XFPC3) 

RHIFC6*3)=-2.*CT*UAl»XFP<4)*<XFPC6>-2.*XFPf3)*0MECAI 

PHlF<6t4)=-0T*HAl*CA2-2.»XFPC4)*fXFP<5)^2.*XFPC4>*CMEGA»> 

PHIF<6f5l=2.*DT*WAl*XFPC4>*XFPf4) 

PHIF<6t6J=l.-2«*0T*WAl*XFPC3J*XFP(4> 

DO  1  I=l«8 
DO  1  J=l«8 

PHIFTd*  JI=PHIF(J*I  I 

XFM(1>=XFPC1 l♦DT•XFPf3»♦.5•DT2*XFPC5) 
XFMC2>=XFP<2)^DT«XFPC4>^.5*DT2»XFPf6> 
XFM(3)=XFPC3I*0T*XFP<5» 

XFMC4»=XFPC4»*DT*XFPC6» 

XFR(5)=XFPC5>-DT*0MEGA*0MEGA*XFP(3) 

XFMCfe>=XFP<6l-DT*0MEGA*0ME6A*XFP<4l 

XFMC7>sXFP<7)*PHIF<7t7> 

XFMf8}sxFP(8)*PHIFCe«8} 
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subroutine  pfopf 
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I 


C 

CALL  MULTCPHIFtPFP»8#8*fi*TEMPl) 

CALL  MULT<TEKPlfPHIFT*8#8»8*’'EHP2> 

CO  2  Irlt8 
00  2  J=lte 

2  FFPfl* J)=TEMP2<I«J>*QF0«I*J1 

C 

DO  30  IslfS 

IF  (PFM(ItI)*6T.O.)  60  TO  30 

PRINT  *,•  NP  ="fNR**  NS  =«*NSt*  PFMC*#If«f  ="tPFMfItI> 

PFF(1 tI>=ABS(PFH(I«I>l 
30  CONTINUE 

C 

IF  <NS.f4E.l}  60  TO  10 
WRITE  C6«7300) 

hRITE(6«7420)  f C QFD (U* Jl * J=1 *8 ) > 

7420  F0RPAT<1X**QF0*#1X«(8E14.5)) 
yRITE<6«7422)  (  CPFP  C  Jt«l)  «  J=1 18  )  > 

7422  F0RI*AT<1X**PFP*,1X#«8E14.5)) 

IF  (<10.LT«NR.ANO.NN.LT«60>.OR.C80»LT.NR> >  60  TO  10 
7300  F0RMAT(/*1X**0IA60NAL  ELE»»ENTS  OFt*  ) 

C 

WRITE(6t 74231  CCPFMf J* J1«J=1 *8 11 

7423  F0RFATClXt*PFM*,lX#<8E14.511 
IF  (MANIND.EQ.ll  60  TO  10 
URITE<6t74191  <<TEFP2CUf J1 •Jsl«811 

7419  F0RRAT(lXf*PUPD*#lXt(8E14.511 

WRITE(6f 74211  (CPHXF(6«J1« J=lt81 1 
URXTE(6«74211  CCPHIFCStJl t J=1*B 11 

7421  F0RRAT<lXt*FHIF*#lX*f8E14«511 
10  RETURN 

END 


PROuRn--  HF2'INPUT,0ljT?i;T.TAPE5=INPij:,TAPE4=0'JrF:j^,TAPE8,TAPE?) 
REA.  TWE(  155)  .SIG(  155.  .RiSC  155)  ,PP(  155>  m  155^ 

REAL  EST(  155)  ,ESTMS(  155)  ,ESTPS(  155)  ,RAN’5E(5) 

REAL  KPEAK.MEA^iA'J 
INTEGER  N«E(28,4) 

CALL  PLOTS 

READ  IN  REffJIRED  DATA 
REWIND  8 

READ(8,100)  N6.NFRf{S,NRUNS,ITAR3 
R£AD(8.28e)  ALPltt,SlGAT,UAW,yARD?G 
F0iWiT(5I3) 

F0fWAT(6E12.5) 

F0Rf1A'^(3F15.^) 

F0Rr¥iT(55X,3F15.i) 

ASSIGN  PLOT  TITLES  TO  CORRESPONDING  DATA  SETS 

NAME(1,1)=18HX  MINUS  PC 

NAfS(2,l)=10Hy  MINUS  PC 

NAME(3,1)=10K):  MINUS  VE 

IWIE(4,1)=10HY  MINUS  VE 

WV1E(5,l)=ieH)(  MINUS  AC 

IW€^4,1)=18Ht  minus  AC 

NWE(7,l)=ieH:<  CDx  MINU 

lW<E)8,I)=10H'i'  CEN  MINU 

NAME(9,l)=10fC<  PuUS  PCS 

NAM£(18,1)=18HY  PLUS  PCS 

f*¥l£(ll,l)=18HX  PLUS  VEL 

f*!tME(12,l)=18H'i'  PLUS  VEL 

1WME(13,1)=10HX  PLUS  ACC 

NAME«:1S1)=18KV  plus  ACC 

N¥1E(15  l)=10HX  CEN  PLUS 

NArME(16,l)=10W  CEN  PLUS 

lWiECi,2)sfWIE(2,2)sW(E(7,2)»4WlE(8,2)*18HS 

NA«£(3.2.'=fWME(4  2)*10HL 

IWME(l3.2)^ME(l4,2)=10HEL 

IWlE(5,2)=NAME(S,25sl0HCa 

N^£(I5,2)=^WE(k,2)=^m(9,2)«4W1E(10,2)*4«1E(ll,2)«t«ME(W 

#10H 

SET  IF  NTfffiER  OF  FR^WES  TIME  AVERAGING  IS  FERPOfJiED  OVER 

IF  (NG.EQ.8)  FRAMES=135. 

IF  <N3.GT.0)  FRAMES=40. 

DO  18  I*1,NFRMS 
TlME(I)=FLOAT(l)/38. 

CALL  SCALECTIME,7.,NPR!iS,l) 

CALL  NEWPEN(l) 

CALL  BlOT(8.,-.5.-3) 

CALL  PL0T(1.6,2.25,-3) 

CALL  PCFF 

PRIN'^  *,  •  INPUT  '-1.'  TO  REPLtr  A  PLOT.* 

PRIN"  I  •  INF.T  '18.'  TO  AVOID  PLOTTING  Tf«  MEAN  ♦/- 

PRIir  *,  *  * 

READ'S,*)  GARBAGE 
PRIN"  L  •  INPUT  DATA  SET.* 

READtS.I)  SET 

PRINT  *.  •INP.r  PLOT  TYPE  :1...RMS  2.... ♦-ERROR* 

READ'S,!)  ITYPE 
CALL  PON 

Nlfi=0 
REMIND  8 
READ(8,22) 


888188 

888118 

888128 

688138 


888158 

888168 


888198 

888288 

888218 

888228 

888238 


888258 

888268 

888278 

888288 

888298 

888388 

888318 

888328 

888338 

888348 


3 

B' 

Ml 

D 

i : 

\l 

7 

'  c 

11 

J 

1  r 

i  i 

■ : 

*  L 

8 

8 

8 

8 

8 

8 

A 

T  F 

■) 

■f 

ii: 

r  888498 
888588 
888518 
888528 
888538 
888548 
888558 
88856? 
888578 
888550 
888598 


N!JM=NUM+1 

ga;;3sa5S(&ir3asd 

IF  (NI^.IC.9)  60  TC  W 
R&iIND  S 
READ(8.22) 

FORmT(50X,/,58X) 

CONTINUE 

iWN3E(l)=IWNGE(2)=e.e 

»£ANAVfcHPB«=S:GA';=e. 

^  (NUNTl^'^ef'READiS.aeCO  EST(I),SIG(I),PP(1) 

IF  (Nll^.GT.8)  READ(S.408)  EST<1)  ,3I8(i)  ,PP(I) 

IF  (E0F(8).NE.e)  GO  TO  999 
ESTMS(!)=EST(:)-S1G(I) 

ESTPSa)=EST(:!)+SIG(I) 

RMS(I)=SQRT(SIG(I)!s*2+E3T(I)«2; 

PI^(I)=-PP(I) 

IF  (NG.EQ.e  .(K).  I.LE.15)  GO  TO  19 
IF  (NG.GT.e  .F0^D.  I.LE.90)  GO  TO  1? 

HE«^U=MEAtW+EST(  I)  /FRAMES 
SI(jA>J=S18W*SIG(I)/FRANES^  . 

IF  (ASS(EST(I)).GT.ASS(MP£AK)J  MPEAK=EST(I) 

CONTINUE 

IF  (ESTMS(I) .LT.RAN8E(  1)  •W^E,EQ.2)  f^3E( l^fSTNSd) 
IF  (RMS(D.LT.fWN5£(lKAND.ITYPE.EQ.I)  »WG£(j)»RHSd> 

IF  (PP(I).8T.IWs5£'2).AND.ITYPE.EQ.l)  RAN8E(2)=P?(I), 

IF  (RMS.'I) .GT.IWNGE(2i .AND.ITyPE.EO.1)  ^X(2)*msa) 

IF  (E3TPSd).6T.RANGE(2).AN0.ITYPE.EQ.2)  RANGt(2)=ESTPS(I) 
COfiTINUE 

CALL  POFF 

F0RM^f2?S(S^*!n5 !*^K^ERfiOR* ,T3e ,*AVG  ERROR* , 


800928 

868930 

800948 

088950 

080y<(e 

880978 

080980 


881000 


001020 
030 


PRINT  K.'INFl"  A  M'  TO  CONTINUE  PLOT' 

READ'S.!)  GARBAGE 
IF  (GARBAGE .NE.l.)  GO  TC  12 
CALL  POf^ 

CALL  SCALE(fiAV3E.4.,2.1) 

HGATaA3S;RAS3E(3VR^SE(4) ) 

DO  25  1=1,2 

EST(NF»tStI)=RANGE(2+I) 

ESTMS(NrRMS+I)=RASt'i(2+I) 

ESTPS(NFRMSd)=RANGE(2+I) 

RMS(NCRMS+U»RANGE(2+I) 

PP(NFR«S+I)«RWGE<:+ri 

PM(NFRMS+I)«RAN8E(2d'. 

COfTINUE 

continue 

CALL  AXISt'0.,0.,I0HTIME  (SEC)  ,-ie,7.,0.,TIME(NrRMS*l),TIME(NFRIlS 

*IF  (NUN.EQ.3S.NI^.E0.4.0R.NIW.E3.11.0R.NUN.EG.!2)  GO  TO  50 
IF  <N'J1.EC.5.0R.N'>^40.i.0R.N^..EC.13.0R.p^4)  GO  TO  68 
CALL  AXIS(0.,8.,14H£RRCR  (PIXELS) ,14,4. ,98., RAN3E(3) , 

IRAN6E(4)) 

GOTO  70 


801410 

081420 

001430 

881440 

881450 


001470 

881488 

001498 

881500 


a 


CALL  AXIS(e..8.,18H£RR0R  (PIXELS/SEC) ,18, 4., 98., 
#RAN8E(3)  ,RWSE(4)) 

GO  TO  78 

CALL  AXIS<8..0..22HERROR  (PIXELS/SEC/SEC)  ,22, 4,, 98., 
«R/^3E(3)  ,RANGE(4)) 

COf/TINOE 

CALL  PLCT(-1.,-1.,3) 

CALL  PlOT(8.,-1.,2) 

CALL  PL0T(8.,5.5.2) 

CALL  PLOT(-l., 5.5,2) 

CALL  PL0T(-1.,-1.,2) 

CALL  Pi.0T(8.,-l.,2) 

CALL  PL0T(8. ,5.5.2) 

CALL  PL0T<-1., 5.5.2) 

CALL  PL0T(-1.,-1.,2) 

CALL  PLOT(8.,HGHT,3) 

CALL  PLOT(7.,HGf(T,2) 

CALL  NEWPB^(2) 

IF  (ITYPE.EQ.l)  GO  TO  98 
CALL  LINE  (TIME, EG''  ,NFJMS,  1 , 15,3) 

CALL  SYMB0L(. 5,4.2,.  1,13H?  ERROP.0.,13) 

IF  (GAF.E.EG.18.)  GO  TO  98 
CALL  NEIs'PENO) 

CALL  LINE(T1M£,ESTM3,NFRMS, 1,15,4) 

CALL  LINE(TIME,ES‘'PS,NFRMS,  1,15,4) 

CAlL  SYMSD;.(. 5,4.0,. i,17H+  HEA*,’  +/-  SIGMA,0.,17) 

GO  TO  lie 

CALL  LINE(TIM£,RMS,NFR«S, 1,15,4) 

CAwL  SyMB0^(.5  4.2  .1,12R+  RMS  ERR0R,e.,12) 

CALL  NEWPEN(3) 

CALL  LIM':TIME,PP,NFRMS.  1,15.3) 

CALL  SVM8:.(.5,4.e,.l,lSHif  FILTER  SIGMA,0.,15) 

CALL  L!NE(TIME,PM,NFRrtS, 1,10,3) 

CONTINUE 

CALL  NEKPEN(l) 

CALL  SyMB0w(.2,5.1,.2,l<HFILTER  ERROR  OF  ,8. ,10 
CALL  SWBO.(  3 .0,5.1,  .2  ,NAME(NUM ,  1)  ,8 . ,  18'- 
CALL  SYMBCL(4.04 ,5.1, .2,N^E(NUM,2)  ,8 . ,  18) 

CALL  SYME^L(1.8,4.75,.1,6HNRUNS=,8.,6) 
call  GTMBOLd.e  4.55,.1,4H  N(^,8.,0 

CALL  SYMBOL  ( 3 . 0 , 4 . 75 , .  1 ,  <H!TAR(5= ,  8 . ,  O 
CAU.  S-'.MBDL(3.8,4.55,.l,6HALPHA=,8.,<f; 

CALl  symbol ''5.0 .4.75, .  1 ,6HWARDF=,8 . ,4) 

CALL  SVMSO.(5.0,4,55,.1.4H  yARM=,8.,4' 


call  Nl)MBER(5.7,4.55,.l,'v)Af?’;,0.,l) 

CAlL  POFF 
GO  TO  12 

R£ADt5,*)  GARBAGE 
CALL  pi: 

CALL  NEWPEN(l) 

C 

IF  (GARBAGE.LT.0.)  60  TO  48 
C 

GO  TO  15 

999  CALL  PLOTEtN) 

STOP 

END 

-END  OF  INFCRMATION- 
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